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This  thesis  discusses  the  modification  cf  an  existing 
Optimal  Systems  Conticl  FORTRAN  Program  (OPTSYS)  originally 
obtained  from  Professor  Arthur  E.  Bryson  of  Stanford 
University . 

The  notified  FORTFAN  program  (OPTSYSX)  is  now  designed 
to  rur  completely  interactively  under  VM/CMS  on  the  IEH  3C33 
and  is  considered  ccnpletely  compatible  with  similar  oper- 
ating sjsterrs. 

Program  capabilities  include:  complete  eigensystem 
analysis;  the  atility  to  perform  computations  on  very  large 
mult ivariatle  systems;  controller,  filter,  regulator  and 
ccmpersatcr  synthesis;  transfer  function  analysis;  steady- 
state  gain  determination;  aid  nodal  analysis. 

Ike  program  permits  users  to  rapidly  carry  out  simula- 
tion, analysis,  end  design  cf  all  classes  cf  Optimal  systems 
Ccntrcl  prctlems  in  a  totally  interactive  mode.  Examples  of 
various  types  of  prctlems  are  worked  out  during  individual 
terminal  sessions. 
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A   =  stats  (Ns,Ns)  or  output  (No, No)  weighting  matrix 

E  =  control  (Nc,Nc)  weighting  matrix 

C  =  control  gain  matrix  (Nc,Ns) 

D  =  control  (Nc,Nc)  or  ncise  (No,Ng)  feedforward 

matrix 

E   =   expected    value 

F    =    cpen-lcop    dynamics    matrix    (Ns,Ns) 

G   =   control  distribution   matrix    (Ns,Nc) 
GAM    =   state    disturbance    distribution   matrix    (Ns,Ng) 

K    =    measurement   scaling    matrix    (No,Ns) 

K    =   estimator    gain   matrix    (Ns,Nob) 
Ic    =    number   of    controls 
lig   =   number  of    process    ncise   sources 
Ns    =    number  of    states 
So    =   number   of    ctservaticns    or    measurements 

J?    =   ccvariance    matrix    of   estimate    error    (Ns,Ns) 

Q   =    white    process   noise   covariance    matrix    (Ng,Ng) 

E    =    white    meas.    noise    covariance    matrix    (No, No) 

S    =   steady-state   covariacce   matrix   of  control    (Nc,Nc) 

u    =   ccntrcl   vector    (Nc,1) 

v    =    white    measurement    ncise    vector    (No,  1)  ,    with 
zero    mean    and   covariance   matrix   R 

w    =    white    process   noise    vector    (Ng,1),    with 
zero    mean    ar.d   covariance    matrix   Q 
wO    =   constant    disturbance   vector    (Ng,  1) 

x    =   state    vector    (Ns,  1) 
se   =   estimate    of   state    vector    (Ns,1) 

y   =   output/measurement    vector    (No,1) 
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The  purpose  cf  tlis  thesis  is  to  describe  the  extensive 
modification  and  improvement  of  an  existing  FORTRAN  program 
(OPTSYS)  used  in  tie  study,  design,  and  application  cf 
Cptiial   Systems    Conticl   theory. 

This  optimal  systems  control  program  was  originally 
developed  by  Hall  [fief.  1 ]  in  1971  to  support  his  research 
in    rctary-wing      VTOL    aircraft   control   systems.  The   latest 

program  icdif ications  were  mads  by  Walker  [Ref.  2]  and  Liu 
[Ref.  3]  cf  Stanford  University,  to  OPTSYS  4  and  CFTSYS  5 
respectively.  These  prograa  versions  performed  quite  satis- 
factorily in  the  batch  environment,  but  exhibited  varying 
degrees  cf  user  hostility  due  to  data  input  format  require- 
aents    and    incomplete    program    documentation. 

The  original  intert  of  this  work  was  to  adapt  Salkex,s 
ircdifisd  version  of  CITSYS  to  run  int aractively  under  VM/CMS 
en  the  I£M  3033;  however,  the  extensive  modifications  of 
CPTSYSX  rcw  represent  a  high-level  interactive  applications 
software  system  caparle  of  integrated  simulation,  analysis, 
synthesis  and  design  of  broad  classes  of  optimal  systems 
ccntrcl  problems.  With  OPISYSX  users  may  now  evaluate 
varicus  specialized  optimal  systems  control  applications, 
relieved  of  the  burden  of  lengthy  mathematical  program 
development . 

It  is  assumed  that  the  reader/user  is  familiar  with  the 
tasic  ccrcepts  cf  Control  Theory  and  Optimal  Systems  Design. 
The  prcfciei  descriptions  and  program  development  fellow  the 
terminclcgy  and  symbol/naming  conventions  of  Eryson 
[Ref.   U]. 

An  explanation  cf  the  tasic  system  of  equations,  the 
terms  and  symbolcgy  used,  and  a  program  overview  including 
the    general   metheds    cf   solution   are   presented   first. 


Interactive  crogiau  dev slcf nent  is  then  discussed,   with 


an  exriarat 


.en 


ci  several   altarna-^  options  avaiiatle  zz: 


date  input. 

Ibis  scik  concludes  with  Examples  zi  various  typ=s  3f 
erotisms  dsmenst rated  in  th€  interactive  mode,  including  a 
copy  cf  each  terminal  session  with  the  final  results.  A 
complete  program  listing  is  included  in  Appendix  A. 
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II.  THE  QPTSYSX  COMPOTES  PROGRAM 

fi-   ISTBCEOCTION 

CP1S¥SX  is  a  double-precision  FORTRAN  program  ercplcying 
modern  centred  theory  analysis  techniques.  Although  the 
frogiai  %as  originally  written  to  synthesize  controllers  ior 
rotary-wing  VTOL  aircraft  [ Bef .  5],  it  has  been  extensively 
codified  tc  enable  controller,  filter,  and  regulator 
synthesis  as  well  as  transfer  function  and  modal  analysis  on 
ether  types  of  large,  multi-variable  systems  of  equations. 
The  program  modifications  described  in  this  work  new  allow 
rapid  numerical  computer  analysis  in  a  completely  interac- 
tive   mode. 

E.       SISlIfl/KODEL    DESCRIPTION 

CEISYSX   treats    a    linear    stationary   system   model: 

x    =    [F]x    ♦    £G]u    +    £GflMMA]w  (2.1) 

cutput    equation 

y    =  £  H  ]x    +    [D]u  (2.2) 

measurement   equation 

z   =   [  H  ]x    +    [D]w   +    v  (2.3) 

where 

u  =  control   vector    (m    X    1) 

v  =  white    measurement    noise    vector    (p   X    1) 

t  =  white    process   noise    vector    (q    X    1) 

x  =  state    vector    (n   X    1) 

1  1 


y  =  output  vector  (p  X  1 ) 

z  -   measurement  vector  (g  x  I) 


[  *  J  1S 


plant      matrix)  ;      [G]      is      the      control    distribution 


ui  a 
i     i 


trix; 

£    the 
ent    a 


[GAMHA]    is    the    process   noise    distribution    matrix;    [H 
neasuieaient    distribution  matrix;    and   and   [D]    say    rsp 
feed-fcrwarc   distribution   matrix    cf    either    the   process    Eoise 
vector    (v«)  ,   or    the    ccr.trcl    vector    (u)  . 

The      w    vector      has    zero      mean    value,         and  a      ccvariarce 
iratris   [C],    where: 


E  (w)     =0 


(2.4) 


and 


[C]   =    E[wwT 


(2.5) 


Ire    v   vector   has   zero   mean    value    and   a    covariance    iratrix 
[R],    where: 


E  (v)     =   0 


(2.6) 


and 


[B]   =    E[vvT: 


(2.7) 


The    quadratic    performance     (or   cost)     index   for   the   linea: 
quadradic   regulator    is   the    expected    valus    cf: 


J   =    V2/{yT[A]y   ♦    ur[B]u}dt 


(2.8) 


in   the      statistical    steady- state,         where   [A]      represents  an 
output   cost      matrix    (a   weighting      on    the      output    variables) ; 
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—  _      G     ^  \-  ...  <-  _  o  .^ 


ana    L 


oatrix. 

If    full    state    weighting 
cy   the   identity    natrix  [I]. 


«.   control    weighting    coefficient) 


desired,      [H]   is    represented 


C.       IBCGiAS    OUTPOT 

1  •      Cc€ nzk2.2.£   £icgnsyst  ej   Ca icuia tiens 

Xhe  initial  portion  of  CPISYSX  output  includes  the 
prcgiair  flc«  control  flags  set  by  the  user  for  that  partic- 
ular run,  the  syst€ir  of  equations  being  modeled,  and  the 
cpen-lccp  eigenvalue  and  eigenvector  calculations  of  the  [?] 
matrix. 

2  •      Eeoulator   S  yr.  the  sis    Calculations 

In  the  solution  to  the  optimal  regulator  prctiem, 
full    state    variakie    feedback    is   assumed    where: 


[C]    =     [B'l][GT][S] 


(2.9) 


and 


u   =   -[CJx 


(2.10) 


The  control  cain  [  C  ]  is  a  matrix  of  optimal  gains 
which    iririmize    the    cost   index   expressed   in    equation    (2.8). 

for  optimal  regulator  synthesis  problems,  program 
cutput  includes  the  closed-loop  eigenvalues  and  eigenvec- 
tors; the  control  gain  £C];  the  closed-loop  dynamics  matrix 
[f-GC];  and  the  steady-state  gain  matrix  [S],  where  [S]  is 
the    steady-state   solution   to   the    algeoraic    Eiccati    equation: 

S[j;    ♦    [FT]S    -    S[G][E'V]CGT]S    +    [  HT3CA  ]£  H  ]    =    0  (2.11) 
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3*      Filter   Synthesis  Calculations 

A      Falaan      filter      cr    Estimator      which      describes      a 
continuous    time    sysxeir   may    te   «ritzen   as: 


x    =   (F]x    ♦    [K](z    -    [H]x) 


(2.12) 


i/u2r  s 


[K]  is   a    matrix   of   filter   gains, 
and    the    state   covariarce   is    described   by: 


I  <xxr ) 


E  jxx    )    +    [P 


(2.13) 


The    filter      gain   matrix  [K]      of   equation       (2.12)      is 
obtained    from   the   relationship: 


[K]  =  [p^h1*;^] 


(2.14) 


iihere      [F]    is      the    steady-state      solution      to  the      algetraic 
Eiccati    eguation: 


[IJI    ♦    P[FT]    -    P[ET]£B-,]£H]E    ♦    [  G  ][  Q  ][  QT]    =    0 


(2. 15) 


representing  the   errcr      covariance   of   the   estimate      x.        The 
ccnticl   ccvariance    is   the  expected   value   described   by: 


E  (uuT)    =  [c;x£cT] 


(2.  16) 


For  the  Kalian  filter/optimal  estimator  synthesis 
problem,  CETSYSX  output  includes  the  eigenvalues  and  eigen- 
vectors cf  the  optimal  estimator  (Kalman  filter)  ;  xhe  filter 
gains  [K^;   the  error  covariance  matrix  [P];   the  covariance 
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Batru   of   the    estimate   [x];       the    state   covariance    matrix   [X] 
describee    ir.  equation    (2.13),    where 

C  X  ]   =    E£xx     *  (2.  17) 


and   tte    control    covariance    matrix      £  "J  ]   described    in    equation 
(2.16)  . 

4,      Stationary    Ciosed-Lccp    Calculations 

The  stationary  response  of  both  state  and  ccntxcl 
are  presented  as  roct-mean-square  values  of  the  state  and 
control  covariance  matricas£X]  and  [  rJ  ]  described  in  equa- 
tions   (2.17)    and    (2.16)    respectively. 

E.       SCIGTICN    ALGCRITB* 

Cne  cf  the  fundamental  techniques  necessary  to  quadratic 
synthesis  cf  optimal  control  systems  is  the  steady-state 
solution  cf  the  alqetraic  Riccati  equation.  This  is  a  ncn- 
trivial    task  due   to    the   iterative   nature   of   the   solution. 

Tte  steady-state  solution  by  any  quadrature  method 
necessitates  time  increment  selection  no  qreater  than  seme 
fraction  cf  the  shortest  period  of  the  closed-loop  system; 
imposing  a  significant  computer  solution  time  expenditure  en 
the  user  as  well  as  the  requiring  an  extensive  amount  of 
computer  storage  caparility  due  to  the  matrix  expansion 
factcr  involved.  Further,  the  possible  necessity  cf  a 
time-varying  solution  of  these  equations  for  optimal  open 
loop  ccrtrcl  or  estimation  requires  the  inversion  cf  an 
n  X  n  matrix  for  each  time  increment  where  an  unsteady  solu- 
tion   is    desired. 

A  powerful  and  efficient  alternate  methed  cf  solution 
was  developed  by  Bryscn  and  Hall  [ Sef .  7],  based  en  eigen- 
vector decomposition  of  the  eigensystem  of  the  constant 
coefficient    EULEH-LAGEANGE    equations. 


15 


Icr      the  optimal      regulator,      these      aquations    take      the 


» 

x 

« 

X 


r 


G    3    G  x 


-FT 


A 


For  the  optimal  filter  or  estimator,   the  equations  are 
of  the  form: 


» 
X 

= 

- 

Gam*3*GamT 

X 

X 

= 

bVh 

-?T 

X 

_      — 

CETSSSX,  and  all  earlier  program  versions,  use  the 
method  of  eigenvector  decomposition  or  the  EOLEE-L&GEANGE 
equations  descrited  in  [Ref.  7]  for  quadratic  synthesis  cf 
control  systems.  Program  calculations  are  based  or.  the  QR 
algorithm  cf  Francis,  modified  by  Wilkinson  [Ref.  8]- 
Impcrtart  features  ci  this  method  of  eigensystem  analysis 
are  its  improved  accuracy,  ar.d  its  insensitivity  to  widely 
separatee  eigenvalues. 

A  mere  detailed  description  of  the  QR  algorithm  ard  its 
numerical  applications  to  eigensystem  analysis  may  be  found 
in  [Bef.  8]. 

i.   EBOGfAM  OVERVIEW 

CE1SYSX  and  its  41  subroutines  may  be  divided  into 
three  basic  categories; 

1)  setup  end  commutation  sequencing 

2)  data  input 

3)  calculation 

A  brief  and  general  description  of  the  program  mcdules 
and  subroutines  supporting  these  basic  categories  concludes 
this  section. 
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1 •      Ere tie m    Ee strict  icn^? r ogr am  Flow   Control 

Xhe   MAIN   program   allows   interactive   selection    z±    all 


crogian    flcv.  centre!      flags,      and    is   aided 


tines  :  EDFEAL,  RDIS1,  and  RDCHAfi.  A  detailed  description 
cf  these  subroutines  is  provided  in  Chapter  III.  Subroutine 
CHECK  verifies  the  consistency  of  all  requested  program 
cpticrs. 

2-  Interactive    Eata    In  put 

Interactive    data   input   is    performed   by  the    14   reae 

subroutines.  A  detcilsd  description  cf  the  operation  of 
these  subroutines  is  also  included  in  Chapter  III.  Internal 
data  generation  or  external  data  input  is  provided  by 
subroutine    SETUP. 

3-  Calculation    Sequenc inq 

Subroutine  UfcER  functions  as  a  second  MAIN  program. 
It  orders  tie  data  input/calculation  sequences  for  the  type 
cf  prcbiei  being  solved  and  performs  numerous  matrix  calcu- 
lations. It  is  frctt  this  subroutine  that  all  input  and 
calculation    sequences   are    ordered   and   performed. 

4  •      £J    Algorithm    Iransf  craia  ticn 

Subroutines  HIHV,  BALANC,  OETHES,  ORTRAN,  HQB,  HQE2, 
EAL3AK,  CNCRM,  and  EREXIT  perform  the  major  calculation 
sequences   cf  the   "QR"   algorithu. 

5*      Riccati    Eauation   Calculations 

Subroutine  FGAIN  separates  the  eigenvalues  and 
eigenvectors  of  the  Euler-Lagrange  equations  by  eigenvector 
deccif csiticn.  RGSIN   and      subroutine      SCOV   calculate      the 

steady-state  soluticr  cf  the  Riccati  equations  for  the 
ccnticller    cr   estimator   problem.  Subroutine   SCOV    computes 
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the   ccvariance  natria  solution 
equation. 


:he  alaebraic   Ric 


i-t  T    —  X  -   ,^  *« 


Subroutine  MCCc  confutes  the  modal  transformations 
required    fcr  modal    analysis. 

"7-      1  r  a  r  sf  e  r  Function  Calculations 

Subroutines  ii,  poles,  zeeos,  besie,  acoh?,  ccomp, 
EC.R,  and  function  SCI  perform  transfer  function  computations 
associated      wizh   nodal      calculation   sequences.  Subroutine 

ESDCM    computes    the    power   spectral   density    of    the    outputs   or 
controls   cf   a  controlled  system. 

8-      I«l«   Output 

Subroutine  R5ERNT  prints  all  program  calculaticrs  in 
object  time  format.  Subroutine  MATTRT  allows  variable 
format   scre=n   viewinc  cf   all   icteractive    matrix   data    input. 
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in.  i I*>ss Acr i ? a.  EBGGSAti  or ^r^tici^ 

1-   IIS3GM  CONSIDERATIONS 

During  the  development  cf  CPTSYSX,  all  program  modifica- 
tions an:  auditions  i»«=re  focused  primarily  toward  interac- 
tive user  operation.  Experience  has  demonstrated  that 
interactive  computer  communication  offers  many  advantages  in 
the  research  and  problem  solving  environment.  The  opportu- 
nity for  flexible  and  immediate  computer  communication,  as 
well  as  the  ability  to  select  alternate  solution  methods, 
are  significant  advantages  to  the  user;  advantages  which  are 
unavailable  in  a  batch  processing  environment. 

Although  previous  versions  of  OPTSYS  produced  all  the 
desired  calculations  in  the  hatch  environment,  the  input 
format  and  data  sequencing  and  naming  conventions  were 
confusing  tc  many  users.  The  user  was  burdened  with  the 
necessity  cf  verifying  the  correctness  of  input  data  format 
and  program  flow  contiol  flag  settings  for  each  program  run, 
in  cider  tc  ensure  the  desired  calculation  sequence  was 
properly  performed. 

Ihese  requirements,  combined  with  incomplete  program 
documentation,  promcted  a  lack  cf  confidence  in  the  results 
and  ciscciraged  many  potential  users  from  even  attempting  to 
use  CETS'iS. 

£.   EECGEAt  LANGUAGE 

CETSYSX  is  programmed  in  FORTRAN  IV,  following  the 
conventions  of  IBfl  System/360/370  FORTRAN  IV  language.  Very 
few  prcgram  features  have  been  been  incorporated  which  are 
ret  written  in  ANSI  Standard  FCRTRAN.  These  subtle  differ- 
ences notwithstanding,   OPTSYSX  has   been  compiled   and  run 
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ander      fccth      FORTRAN      IV       (G1)         and      FORTRAN      H       (Er^r.d^d) 
compilers   cl      the   IBS  3033.  Although    the     overall    prcgraa 

length   :5   ir   bxczss    cf   2300    lines   of    zezz,      it  is    considered 
completely    portable    ficm   one   ccerating   system   to   another. 

Cr  th€  presumption  th  at  most  scientific  and  research 
personnel  are  familiar  with  FORTRAN  language,  program  modi- 
fications may  be  easily  undertaken  once  system  operation  is 
understood. 


C.       GIKZBAI    PROGRAM    KCEIFIC ATICNS 

£11  cf  the  previously  developed  numerical  calculation 
sequences   cf  OPTSYS    were   retained   un-modif ied   in    QPTSYSX. 

Those  program  sequences  requiring  the  input  cf  diagonal 
cost  cr  ccvariance  matrix  elements  were  deleted  or  modified 
to  imprcve  user  flexibility  in  entering  any  desired 
weighting  matrix,  diagonal  cr  otherwise.  This  modification 
streamlined  program  operation  through  elimination  cf  several 
program  flcs  control  flags;  reduced  a  measure  of  user  uncer- 
tainty; anc  further  decreased  the  required  degree  of  user 
program    fa iiliarity--promcting    uninterrupted   operation. 

The  FEAE  sutroutines  represent  variations  on  the  prin- 
ciple cf  simple,  effective  nethods  of  interactive  input, 
coupled    Kith   errcr-ccrrecticn/reccver y   sequences. 

Subroutines  RDCHJ.E,  RDINT,  and  RDREAL  were  developed  by 
the  author  and  Cdr.  P.B.  Sullivan  to  accomodate  varying 
input  format  requirements;  null-string  entry  protection  was 
developed  by  Cdr.  P.E.  Sullivan.  These  program  features  ara 
discussed    in   greater    detail    later   in    this    chapter. 
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E.   INTERACTIVE  ER0GI3E  DEVELOPMENT 

1  •   ricgiaoi  Flew  Centre  1 

Initial  prociam  development  required  an  under- 
standing ci  the  various  problem  descriptions  as  well  as 
progran  input  and  calculation  seguance.  After  careful  anal- 
ysis of  [Eef-  2],  a  tasic  program  flow  control  diacrair.  :«as 
established.  From  thrs  flow  control  diagraat,  a  ^cgicai 
branching  network  was  formulated  whose  path  could  be  deter- 
mined through  either  binary  logic  or  numerical  selection. 

Three  basic  branching  categories  were  established 
from  the  various  problem  description  statements: 

Logical {"Yes"  or  "No"..} 

Integer {"  1",  "2",  etc. . .} 

Real  Nuirher {"Input  the  value  of...} 

Frcn  the  viewpoint  cf  free-format  computer  ccamuni- 
caticr,  integer  and  real  number  input  presented  no  signifi- 
cant problems.  FOEIRAN  ccmpiler  language  is  written  such 
that  numerical  data  input  (real  number  or  integer)  is 
expected,  thereby  ieguiring  enly  an  INTEGER  or  REAL  data 
type  statement  within  the  program.  Once  the  data  type  has 
been  declared,  the  desired  values  may  then  be  input  with  a 
free-format  READ  (5,*)  statement. 

Cne  note  of  caution  concerning  numerical  data  input 
in  free-format  deserves  mentioning:  Although  all  FCETBAN 
compilers  treat  character  string  input  as  an  illegal  data 
type  conversion,  many  will  automatically  convert  the  inad- 
vertent character  entry  to  a  "zero"  and  continue  execution. 
Erotecticn  against  inadvertent  errors  cf  this  type  is 
discussed  later  in  this  chapter. 

logical  input  ("Yes"  or  "No")  poses  a  unique  problem 
to  prcgiammers.  The  usual  method  of  incorporation  is  to 
require  the  user  tc  convert  the  logical  answer  into  an 
integer  i.e.,  "Yes"  =  1,  "No"  =  2.  These  integers  may  then 
be  read  cirectly  intc  the  program,  determining  program  flew. 
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Although  this  methcd  zay  promote   programming  e^se, 
it   requires   the   user    to  adopt   an  unnatural     bit 
pattern — one   which  iicreases   the   possibility  of   aor.c_ 
program  termination  in   the  event  of  in  ad  vert  ant  ussr  ?::::. 

I  mere  refined  (from  a  programming  language  stand- 
point) and  ergonomic  (from  the  user  viewpoint)  methcd  of 
logical  selection  involves  utilization  cf  the  entire  char- 
acter string  answer  as  an  input  value.  This  method  has  been 
incorporated  into  OF1SYSX. 

The  logical  strings  ("Yes"  and  "No)  are  declared  as 
character  strings  in  a  data  type  statement  within  the 
progran  cr  subprcgrac.  A  format  statement  is  also  included 
in  the  prcgram  or  subprogram  utilizing  the  MA"-field  to 
specify  the  desired  character  field  width.  A  REWIND  state- 
aent  is  then  inccrporated  in  the  specific  program  or  subpro- 
gram immediately  pricr  to  each  logical  string  input  point. 
Ihis  HE KIND  statement  allows  the  input  device  (the  terminal 
screen  in  this  case)  to  read  the  character  string  in  the 
same  iranrer  as  free-format  data  input.  The  character  field 
width  for  this  modification  was  established  at  A1,   allowing 
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or 


streailined   operaticr      with    the      user   typing      either 

"Yes"    fcr   an  affirmative   reply;      "N"      or    "No"    for    a   negative 

reply. 

2  •   General  Input  Segue  ncing  Bequirements 

All  data  input  to  OFTSYSX  is  in  matrix  or  vector 
format.  This  data  input  must  be  correlated  in  accordance 
fcith  the  prcblem  description  and  then  properly  seguenced  in 
crder  fcr  the  prcgran  to  perfcrm  the  dasired  calculaticns . 

The  original  and  modified  OPTSYS  programs  [Eef.  2] 
and  [Ee£.  3]  reguired  not  only  problem  description  knowledge 
tut  ccmplete  user  faiiliarity  with  the  detailed  calculaticn 
seguerce  cf  the  program.  The  latter  point  was  considered  a 
significcnt  disadvantage.    Elimination  of  this  disadvantage 
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was   en   area   where   interactive   programminq   offered   the 
greatest  benefits  tc  the  potential   user;   ans  it  was  toward 
this  s:i  that  the  renaining   aicdif ications  of  0PTS2SX  war 
directed. 

3  •   Interactive  Eata  In  put 

In  its  calculation  sequences,  OPTSYSX  requires  the 
input  cf  up  tc  14  unique  matrices  cr  vectors.  Cnce  the 
previously  described  program  flow  control  diagram  was 
construct  sd»  data  entry  pcints  for  each  matrix  cr  vector 
were  established.  At  each  cf  the  16  program  data  entry 
points,  the  required  input  matrix  cr  vector  was  determined. 
fourteen  input  subroutines  were  added  tc  the  original 
program  in  crder  to  accomodate  interactive  data  entry. 

Ihese  matrix  input  subroutines  were  written  such 
that  the  user  is  first  informed  which  specific  matrix  or 
vector  is  required;  then  prompted  for  the  individual  matrix 
element  values.  These  values  are  then  individually  end 
sequentially  entered  from  the  terminal.  Once  the  matrix  or 
vectcr  is  filled,  it  is  returned  to  the  terminal  screen  fcr 
user  verification  anc  correcticn  if  necessary. 

Interactive  sequential  data  entry   was  programmed  by 

leans  cf  a  two-dimensional  EC  loop,   with  a  terminal  prompt 

cf  the  matrix  name  and  element  position  prior  to  the  element 

value  entry.    Data  element  input   is  via  a  free-format  READ 

(5,*)  program  statement. 

Cnce  the  matrix  data  entry  sequence  is  complete, 
that  input  matrix  is  returned  to  the  terminal  screer:  in 
variatle  fcrmat  for  user  ease  in  row  identification.  With 
an  arbitrary  data  field  width  cf  12  characters,  the  maximum 
number  of  matrix  elements  available  on  an  80  column  terminal 
screen  is  six.  Provided  the  matrix  column  dimension  is  less 
than  six,  this  restriction  presented  no  programminq  fcrmat 
limitations. 
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Per  those  matrices  whese  column  dimension  exceeded 
six,  elements  were  progressively  written  on  sursscuent 
terminal  lires.  Once  the  matrix  row  is  filled  the  zc:  -  :.  is 
double-spaced,  and  element  display  is  reseated  in  ths  same 
fashion.  This  cethed  allows  the  user  to  view  the  aatrix 
cuch  as  he  would  expect  to  see  it,  providing  the  advantage 
cf  ease  in  row  and  eclumn  identification. 

Kithin  CPTSYSX,  subroutine  HATP3T  performs  this 
variatle-f crmat  print  Sequence.  The  print  sequence  was 
arbitrarily  terminated  with  a  matrix  size  of  15  X  16, 
presuming  that  users  with  larger  systems  of  aquations  would 
select  alternate  foms  of  data  input. 

1 «   Saving  Interactive  Input 

In  most  control  system  design  problems,  the  system 
matrices  generally  reiiain  relatively  unchanged  for  a  dssired 
sequence  cf  design  calculations. 

In  order  tc  relieve  the  user  of  the  burden  of 
repeated  system  entry  in  the  interactive  mode,  several  addi- 
tional prcgram  flow  ccntrol  flags  were  added,  allowing  the 
cpticr  cf  saving  the  entire  original  system  of  matrices  for 
subseguent  calculations.  Separate  options  for  saving  each 
systen  matrix  are  automatically  offered  at  the  end  of  each 
program  run. 

Ihese  matrix  saving  options  provide  a  further  advan- 
tage to  the  user  in  that  the  matrices  are  redisplayed  fcr 
verification  pricr  tc  calculation  execution.  Users  may  then 
change  individual  matrix  elements,  relieved  of  the  burden  of 
full  system  re-entry. 

5-   Sser-Def ined  Input  Files 

Although  the  tasic  objective  of  this  work  is  to 
provide  the  user  with  a  totally  interactive  method  cf  data 
input,   several   disadvantages  tc   the  method  of  individual 
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matrix      el€ient      input      are   apparent--icput      cf      verj      large 

ira:::ccc   is   unwieldy   and  time-consuming;    inpuz  cf    systems    cf 
matrices   whcse    elements   remain   unchanged      from  run   tc    iue   is 

iref f icient . 

In  crder  tc  provide  an  increased  measure  cf  user 
flexibility  in  data  input,  subroutine  SETUP  was  modified  to 
indues  provisions  fcr  matrix  data  input  from  a  data  file  en 
the  user's  disk.  The  three  system  matrices,  [F3,[G],  and 
[GAHH5]      may  new      be      input    frcm      the      user's   disk.  Kinor 

program    ncdif ica tion    is    required    of    the    user    as    follows: 

a.  FRICMS    Filedef   commands   must    be   modified    or 
added    tc   reflect   the   name   and   location   cf 
each    data    sat. 

b.  The    REAE   Format    statement    (or   statements)     mis- 
be  changed   to    reflect   the    proper   data    format 
of  the    user's    input   file. 

6  •      Internal  Data  Generaticn 

As  a  further  neasure  cf  flexibility,  the  documenta- 
tion withir  subroutine  SETUP  was  expanded  to  include  several 
specific  examples  of  internal  matrix  data  generaticn.  The 
three  system  matrices  [F],  [G],  and  [GAMMA]  may  generated 
either  fcithin  user-written  twc-dimensicnal  DO-locps  or  by 
direct  assignment  statements.  These  methods  may  be  prefer- 
able fcr  the  input  of  very  large  matrices  with  few  non-zero 
elements. 

I  specific  example  cf  internal  program  generaticn  of 
the  cutput  equation  [H]  matrix  is  included  in  subroutine 
FEADE.  This  matrix  input  method  may  be  preferable  for  the 
entry  cf  a  large  output  equation  matrix  with  very  few  ncn- 
2erc    elements. 

Cnce  these  ccdificaticns  have  been  made  tc  subrou- 
tine SETUP  or  subroutine  READE  (as  desired) ,  the  crcgram 
should    te   re-compiled   and   then   run   in    the    usual   manner.        An 
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interactive  program  prcmpt  is  provided  at  ths  beginning  of 
CPTSYSX  offering  the  user  the  option  of  specifying  fch  i 
desired    method    of   data   input. 


to   input  ths     [H]   matrix    (or   ether     required    input    matrices) 
from    separate    data    files.  Users    with    rudimentary    program- 

ling  skills  may  now  codify  subroutine  BEADH  (cr  cn€  cf  the 
ether  specific  BEAD  subroutines)  in  the  manner  previously 
describ€d  for  subroutine  SETUP  or  subroutine  REACH. 
retailed  examples  of  the  nature  and  extent  of  these  medifi- 
caticrs    nay   be    found    in   Appendix   A. 

7  -      £§!§  Entry   Correction 

In  an  effort  to  protect  users  from  errors  in  data 
input,  an  error  correction  sequence  was  incorporated  into 
each    Beatrix   input   subroutine. 

Cnce  the  entire  matrix  cr  vector  is  displayed  en  the 
terminal  screen  the  user  is  prompted  with  the  question, "Do 
you  wish  to  change  tie  value  cf  any  matrix  element?  Type 
•Yes'  cr  'Nc'."  If  the  user  types  "No",  program  execution 
continues . 

If  the  user  types  "Yes",  he  is  then  prompted  with 
three  additional  statements  specifying  the  row  number  of  the 
element  tc  be  changed,  the  eclumn  number  of  the  element  to 
be  chanced,  and  the  value  to  be  inserted  into  that  rcatrix 
element.  After  the  corrected  value  is  entered,  the  new 
iratrii        values  are        returned        to        the  screen        for 

re-verif ication. 

Ihis  correction  sequence  continues  indefinitely 
until  the  user  signifies  that  no  additional  changes  are 
necessary.      Program   execution    then   proceeds  normally. 
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I.       OSEE-EBBOB    P50TEC1ION    FE1T0BES 

Bany      interactive   computer      programs      suffer    the      irkinG 

c*.a—  -.-. c  ^ s  ._c      Cj.      abnormal      program      termination       {'-;i~.".c_~ 

i6ccv€iyi)  should  the  user  inadvertently  make  an  erroneous 
keyboard      entry.  -Examples      cf      thes=:     inadvertent      hirers 

ircluce--er try  of  a  keyboard  chariots  or  character  string 
when  the  program  expects  a  numerical  value;  entry  cf  a 
numerical  value  vher  the  program  is  expecting  a  character 
string;  entry  cf  a  null  string.  In  order  to  preclude 
abnormal  program  termination  due  to  these  types  of  inadver- 
tent user  errors,  several  program  protection  features  were 
incorporated  intc  OP15ISX. 

1  •      l£ta  Tj£e   Cor  version    Errors 

'Ihree   sutroutines — EBBEAL,    SDINT,    RDCHAR--were    added 
to    CETSYSX      in    order      to    ensurs    that      the    proper      input   data 


type      is    prcvided      tc   the      program. 


Subroutine    RDBEAI      is 


called  at  any  pcint  a  real  number  or  zerc  integer  inputmay 
he  encountered;  subroutine  EDINT  is  called  at  any  pcint  a 
non-zero  integer  input  is  required;  subroutine  RECHAR  is 
called  at  ar.y  point  a  character  string  ("Yes"  or  "No")  input 
is    required. 

lithin  each  cf  these  subroutines  a  null  strir.q  €ntry 
protection  loop  was  incorporated  (allowing  cne  recovery); 
prompting  the  user  for  the  correct  data  type  input,  and 
returning  an  error  message  in  the  event  an  incorrect  data 
type    is    encountered. 

lithin  subroutine  EDINT,  improper  data  type  entry 
was  further  protected  by  the  addition  of  a  three-way  I? 
ccmpaiiscn    cf      entry   integer   magnitude.  This    modification 

precludes  illegal  (but  automatic,  with  some  compilers)  data 
type    conversion    errors. 
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These  prcgraa  design  features  boast  the  additional 
advartace  cf  allowir.g  normal  program  termination  at  snj 
point  in  the  data  incut  prase  by  merely  pressing  the  "Enter" 
k^y    mice. 

2  •      Inconsistent   Jrro.gr a  jr    Control    Fiacj    Err crs 

Earlier    versions     of   OETSYS      [Ref.    2]  and      [Ref.    3], 

did  provide  user  error  rriessaces  in  the  event  cf  inconsistent 
program  flew  centre]  flags,  but  terminated  the  program. 
This  feature  was  undesirable  from  the  standpoint  cf  smooth 
interactive    program    operation,    and    was   improved   in   OITSYSX. 

Subroutine  CEECK  was  modified  tc  include  55TURN 
statenents  any  time  inconsistent  program  flow  control  flags 
are  encountered.  The  user  is  notified  cf  the  type  cf  error 
encountered;  that  run  termiration  has  occurred;  and  prompted 
regarding  his  desire  to  return  to  the  beginning  of  the 
program    or    terminate    execution   completely. 
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IV.  iSCGS&M  OS J  AND  EXAMPLES 


This  chapter  contains  several  basic  examples  cf  the 
numerous  types  of  problems  which  may  be  solved  using 
CPTSYSX.  Included  with  these  examples  are  copies  cf  each 
recorded  t  e  r mi ns 1  session* 

Potential  users  should  exaiine  carefully  the  example  of 
program  failure  found  in  Section  D.  This  example  clearly 
demonstrates  that  urstable  mcdes  or  incorrect  choice  cf 
certair  design  parameters  may  cause  program  failure  (and 
incorrect  output!),  even  with  the  highly  stable  "Q5"  algo- 
rithm. It  also  indicates  cne  possible  method  of  correcting 
this  type  cf  failure  ty  merely  making  a  very  small  charge  to 
cne  cf  the  design  parameters. 


A.   CPEN-LCCP  EIGE3SISTE3  AHA1YSIS 

The   following  open-loop   eigenvalue   example  was   taken 
from  [Eef.  9,  p. 669]. 

Exsmination  of  the  follcwirg  program   output  shews  cpen- 
lccp  eigenvalues  at  -1,  -2,  and  -3.   Note  that  the  eigenvec- 
tors cf   the  left  and  right  eigenvector  matrices   (pa.   33) 
correspond  in   column  fashicn   tc  the   open-loop  eigenvalues 
calculated  immediatel}-  above  them  (pa.  32)  . 

The  full  terminal  sessicn  is   recorded  below,   with  user 
input  in  1c  wer  case  letters  following  each  "?"  . 

record  en 

EEGIS  EECOBCING  CE  TEEKINAL  SESSION 

E;  T=C.01/0.02  21:49:30 

filedef    C6    term    (reefs   fa   blksize    133 

global   txtlib   fortmoc2   mcd2eeh   imsldp   ncnimsl 

lead    cptsysx    (start 
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EXECC3IC5    EEGINS... 

CPTSYSX    IS    A   COMPLETELY    INTERACTIVE    OPTIMAL    SYSTEMS    CCJ 

EBCGEAM.    IT     KILI    SCLVE     SUMESCUS    CONTROL    PBOBLEMS    GN    TEE 
FCILCWIKG   TYPES    C5    SYSTEMS    CONTROL    EQUATIONS: 
2DOT    =     (?)*X    +     (G)*U    +     (GAM)*(W+W0) 
MEASUREMENT    EC.0A1ION — 
Z    =     (H)*X    +      (C)  *W 
BEGULAT05    PERFORMANCE    INDEX  — 
J    =    1/2     *    INTEGRAL      (Y-*(A)*Y    +    Uz*  (S)  *U)  DT 
STATE    FEZEEACK    GAIN    DEFINITION  — 
G    =    -(C)  *X 
EC    YCU    WISH    TC    CONTINUE?       TYPE    "YES"    Ofi    "NO". 


yes 


yes 


EC 


--EAIA    ENTRY  — 
AIIECCGH    OPISYSX    IS    SPECIFICALLY     DESIGNEE    TO    READ 
AIL    MATRIX     EATA    INTERACTIVELY,     SEVERAL    ALTERNATE 
KEIEGDE    ARE    AVAIIA3LE    TC    USERS: 
HETBCE     1—  THE    "F","G",     AND    "GAMMA"    MATRICES 

MAY    BE    BEAD    FECK    SEPARATE    DATA    EILES. 
METfcCE    2 — THE    "F","G",     AND    "GAMMA"    MATRICES    MAY    EE 

EXPLICIILY    DEFINED    WITHIN    SUEROUTINE    "SETUP". 
(NCTE:    IN     EITEZ5    CASE,    TEE    USER    SHOULD    CBTAIN    A    CCPY 
OF    THE     tSCGEAM    LISTING    AND    EXAMINE 
THE    EXAMPLES    CONTAINED    IN    S/R    "SETUP".) 
DC    YCC    WISH    TO    CONTINUE?       TYPE    "YES"    OR    "NO". 

EC     ICC    WISH    TO    IKFUT    THE    "F",     "G",     AND    "GAMMA" 
MATRICES     FECM    SUBROUTINE    "SETUP"    IAW    THE 
METHOD    DESCEIBED    CN    THE    PREVIOUS    SCREEN? 
TYPE    "YES"    OR    "NO". 

GENERAL    OPISYSX    OPTIONS: 
CP1ION     1     —     SYSTEM     ANALYSIS    WITHOUT 

CPEN-LOCP    EIGSNSYSTEM    CALCULATIONS. 
CPTION    2    —     SYSTEM    ANAIYSIS    WITH    OPEN-LOOP 

3C 


EIGENSYSTEM    CALCULATIONS. 
CETIOU    3    --    CPEU-LOCE    EIGENSYSTEM    FOUND 
2ND    PROGRAM    TERMINATES. 
("F"->ATRIX    EKT5Y    FOLLOWS    IMMEDIATELY.) 
CFIICN    1    —    MCDAL    DISTRIBUTION    MATRICES    COKFUTEE 
KIIHGUT    FIITEE    Ofi    REGULATOR    SYNTHESIS 
CF    STEADY-STATE    ANALYSIS. 
SELECT    AN    OPTION:     1,2,3,     OR    U. 


ENTER    THE    #    OF    STATES     (NS)     OF    THE    SYSTEM    MATRIX 
"F"-MaTRIX    . 


ELJ.G/FAFAMETER    SE1TINGS     FOR    THIS    RUN    ARE    AS    FCLLCWS: 
IOL       IC  IS      ISS       IC      ITF1       ITF2      ITF3    IFDFW    IE    IEEEUG 

20  00C0  0  0000 

ISET       ID5TAE      IPSO       I*U      INCEM       IREG       NS       NC      NOB       NG 

0  0  0C0  03000 

ORDER    CF    SYSTEM   =       3 

NUMEER    CF    CONTROLS    =      0 

NUMEE5    CF    CBSER VATIC SS    =       0 

NUMEEF    CF    EROCESS    NCISE    SOURCES    =      0 

ENIEB    THE    SYSTEM    MATRIX       "F"-MATRIX 

DIMENSION    =    #    STAIES     (NS)     X    #    STATES     (NS) 
TEE    ELEMENT    F(     1,    1)  = 


IHE    ELEMENT    F (     1,    2)= 


TEE    ELEMENT    F(     1,3)  = 
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3HE    ELEMENT    F (    2,    1)= 


TEI    ELEMENT    F(     i,    2)  = 


3HE    ELEMENT    ? (    2,    3)= 


TEE    ELEMENT    F(     3,     1)  = 


-6 

-11 

-6 


3HE    ELEMENT    F (    5,    2)= 


IKE    ELEMENT    E(     3,    3)  = 


THE    SYSTEM    MATRIX 
C.C  1.0CC00  0.0 

CO  0.0  1.00000 

-6.CCQ0G        -11.0CCO0  -6.C0000 

DO    YCU    WISH   TO    CHANGE    THE    VAIUE    OF    ANY    MATRIX    ELEMENT 
ISPS     "XES"    CE    "NO". 
E 

OEEN    LCCF    DYNAMICS    MATRIX.. F.  . 

0.0  0.100CI+01         0.0 

O.C  0.0  0.1000D+01 

-0.60C0E  +  0  1      -0.11QCE+02      -C.6000D+01 

CPEN    LGCE    EIGENVALUES DET(SI-F).. 

-1.00CCQI*OC:-2.0000C£+0  0:-3.0000  0D+00: 
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CPEH    ICCE-    FIGHT    EIGEfrVECTOR  MATRIX T.... 

-5. 7735C3E-C1    -  2. 1 82  17SD-01       1.C48285D-01 

5.7735C3D-C1       4.364358D-01  -3  . 1  44355  ?)-q  1 

-5. 772503E-C1    - 8.728716D-01  S.434564D-01 

OPEN    ICCE    LEFT    EIGENVECTOR    MATEIX T-INV.. 

-5.  196152D  +  CO  -  4  .330  127D  +  00  -8  .  660254D- 0 1 
1.37JI773D+C1  1.833C3QD+01  4.582576D+00 
9.539392E+00       1.430SC9D+01       4.769696D+00 

AH&IYSIS    COMPLETE.     EG    YOU    WAN!    ANOTHER    RUN? 
TYPE    "YES"    OR    "NO". 


EO 


CFTSYSX    IS    NCfc    TERMINATED 


E;    I=C.26/0.89    21:52:C8 

rsccrd   off 

END  EECCFDING  OF  TERMINAL  SESSION 

E-   EEGUIATCR  SYNTHESIS 

lie  fcilowing  regulator  synthesis  example  was  taker  frcm 
"Lecture  Nctes  en  Advanced  Ccntrol  Systems",  by  Professor 
D.J.  Ccllirs  of  the  liaval  Postgraduate  School,  Monterey, Ca. 
This  example  invcivec  determination  of  the  optimal  regulator 
gains  cased  on  an  arbitrarily  chosen  quadratic  index;  with 
the  varicus  system  arc  cost  matrices  described  belcw. 

Examination  cf  the  extensive  program  output  indicates 
that  the  optimal  regulator  gains  are:  -5.0  and  -SQRT(IC.C). 
The  alcerraic  sign  ci  the  gains  is  consistent  with  the  defi- 
riticr  displayed  on  the  first  screen  of  the  program  (pa. 
34)  . 

The  full  terminal  session  is  recorded  below,  with  user 
input  in  lc  wer  case  letters  following  each  "?"  . 


ieccra  cr 

EEGIK    EECOEEING    CF    TEFtflNAL     SESSION 
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?;  I=C.G1/C.G2  13:55:26 
filec€f  C6  tern  <racfrr  fa  blksizs  133 
global  titlib  fcrtmoc2  mod2eeh  imsldp  nonimsl 
load  cptsysx  (start 
EXECCSICJ  BIGIHS... 

CPTSISX  IS  A  COMELETEIY  INTERACTIVE  OPTIMAL  SYSTEMS  C0NTRC1 
ESCGFAB.  IT  WILL  SOLVE  NUMEROUS  CONTHOI  PRG5LEKS  CK  TEE 
FCILCBIKG  TYPES  Cf  SYSTEMS  CCNTBCL  EQUATIONS: 
XEOT  =  (F)  *X  -•■  <G)*U  +  (GAM)*(W+W0) 
KEASIFEMENT  EQUATION — 
Z    =  (H)  *X  +  (D)  *«  +  V 

EEGUIATCE  PEEFCBMANCE  INDEX  — 
J  =  1/2  *  INTEGP.AI  (Yt*(A)*Y  +  Ut*(B)*U)ET 
STATE  FEEDBACK  GAIN  DEFINITION  — 
U  =  -(C)  *x 
DC  YCU  WISH  TC  CONTINUE?   TYPE  "YES"  OH  "NO". 

y 

—  EATS  ENTBY  — 
AIIECUGH  OPISYSX  IS  SPECIFICALLY  DESIGNED  TO  BEAD 
AIL  MATEIX  EATA  INTEBACTI VELY,  SEVEBAL  ALTERNATE 
'txTECES  ABE  AVAIIA5LE  TO  CSEBS: 

METKCE  1 — THE  "F"r"G",  AND  "GAMMA"  MATBICES 

MAY  £E  BEAD  FBCM  SEPABATE  DATA  FILES. 
KETHCE  2  —  THE  "F","G",  AND  "GAMMA"  MATBICES  MAY  EE 

EXPLICITLY  DEFINED  WITHIN  SUBBOUTINE  "SETUE". 
(NCTE:  IN  EITHEE  CASE,  TEE  USES  SHOULD  OBTAIN  A  CCPY 
OF  THE  EBOGRAM  LISTING  AND  EXAMINE 
THE  EXAMPLES  CONTAINED  IN  S/B  "SETUP".) 
EO  YOU  WISH  TC  CONTINUE?   TYPE  "YES"  OB  "NO". 

y 

EC  YOU  WISH  TC  INPUT  THE  "F",  "G",  AND  "GAMMA" 

MATBICES  FECM  SUBEOUTINE  "SETUP"  IAW  THE 

METHOD  DESCRIBED  CN  THE  PBEVIOUS  SCBEEN? 
TYPE  "TES"  OB  "NO". 
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7 
2 

ro 


GItERAL    CFTSYSX    OPTIONS: 
CITION    1     --    SYSTEM    ANALYSIS    WITHOUT 

OPEN-LGCE    EIGENSYSTEM    CALCULATIONS. 
CFTION    2    —    SYSTEM    ANALYSIS    WITH    OPEN- LOOP 

EIGENSYSTEM    CALCULATIONS. 
CITION    3    --    OPEN- LOOP    EIGENSYSTEM    FOUND 
AND    PrCGFAd    TERMINATES. 
("F"-KATRIX    ENTRY    FOLLOWS    IMMEDIATELY.) 
CITION    4    --    30DAL    DISTEI3UTI0N    MATRICES    CONFUTED 
WITHOUT    FILTER    OR    REGULATOR    SYNTHESIS 
OR    STEADY-STATE    ANALYSIS. 
SELECT    AN    OPTION:     1,2,3,    OR    4. 


DC    YCD    DESIRE    RES    VALUES    CF    STATS    AND    CONTROL? 
TYPE    "YES"    CR    "NO". 

CITSYSX    LQE/CLASSICAL    OPTIONS: 

CITION    1     --    CPTIMAL    FILTER  ANC/OH    REGULATOR 

SYNTHESIS    WITH  NO    EXTERNAL    "C"    OR    "K" 

MATRIX    INPUT. 

CITION    2    --    OPTIMAL    FILTER  AND/OR    REGULATOR 

SYNTH FSIS    WITH  EXTERNAL    "C" 

MATRIX    INPUT. 

CITION    3     --    CPTIMAL    FILTER  AND/OR    REGULATOR 

SYNTHESIS    WITH  EXTERNAL    "K" 

MATRIX    INPUT. 

CITION    4     --    OPTIMAL    FILTER  AND/OR    REGULATOR 

SYNTHESIS    WITH  EXTERNAL    "C"     ANE    "K" 

MATRIX    INPUT. 

SELECT    AN    CITION:     1,    2,    3,  OR    4. 


IC    YCU    WISH    TO    EETERMINE    THE    STEADY-STATE    RSSIONSE 
FOR    A    CONSTANT    DISTURE2NCE? 
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TYPE    "YES"    CR    "NO". 

CC    YCU    WISH    10     EE1F.BMI8E    THE    MODAL    DISTRIBUTION 
SHE    GAIN    MATRICES? 
TYPE     "YES"    CE    "NO". 

OPEN-LOOP    TRANSFER    FUNCTION    OPTIONS: 
CEIICN    1     —    NC    OFEN-IOCE    TBANSF2B    FUNCTIONS    COMPUTED 
CETICN    2    —    PCIES,    RESIDUES,    AND    ZEROS    COMPUTED. 
CIIICN    3    —    OMY    POLES    AND    ZEROS    COMPUTED. 
CETICN    4     —    OMY    POLES    2ND    RESIDUES    COMPUTED. 
SELECT    AN    CETICN:     1,    2,    3,    OR    4. 


NOISE    TRSKSFER    FUNCTION    OPTIONS: 
CPTION    1    --    5C    NOISE    TEANSFER    FUNCTIONS    COMPUTED. 
CETION    2    --    ECLSS,     RESIDUES,    AND    ZEROS   COMPUTED. 
CPTION    3    —    CKIY    POIES    AND    ZEROS    COMPUTED. 
CETION    4    --    CNLY    POIES    AND    RESIDUES    COMPUTED. 
SELECT    AN    CETION:     1,    2,    3,    OR    4. 


COMPENSATOR    TRANSFER    FUNCTION    OPTIONS: 

CPTION    1    --    KC    COMP.    TFANSFEfi    FUNCTIONS    COMPUTED. 
CPTION    2    —    ECLES,     RESIDUES,    AND    ZEROS    COMPUTED. 
CPTION    3    —    CKIY    POIES    AND    ZEROS    COMPUTED. 
■     CPTION    4    --    CNLY    POLES    AND    RESIDUES    COMPUTED. 

(NOTE:    A    CCMPENSATCE    TRANSFER    FUNCTION    CAN    EE 
COMEUTED    CNLY    IF    BOTH    A    REGULATORAND 
FII1ER    ARE    SYNTHESIZED    AND/CR    INPUT.) 
SELECT    AN    CETION:     1,    2,    3,    OR    4. 


IIII    A    FEED-FORUED    DISTRIBUTION    MATRIX 
("E"   -    MATRIX)     BE    INPUT    ? 
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TYPE    "TIES"    OE    "NO", 
no 

IHIS   CrIIC,v.  DETERMINES    the   criteria   for   deciding    when    A 
MABKCV    EAEAHET2S    13    ZZHO-THZ    8ARK07    PAHAMSIER    INDICATES 
THE    CRDEE    CF    THE    NUMERATOR    FCIYNGMIAL    Of    EACH   TRANSFER 
FUN CIICS. 

AIL    MN«    ZEROS    OF    1HIS    POLYNOMIAL    ARE    PRINTED    OUT    AND 

THIS    TEST    TELLS     ECH    MANY    EXTRA    ROOTS    EXIST    AT    Z    =    0. 

IESS    THAN    10-0**  (-IE)    IS    CONSIDERED    ZERO. 

TEE    DEFAULT     VALUE    CF    THIS    PARAMETER     (IE)     IS    6. 
15    CTHER    WORDS,    IE    =     1.CE-6. 

IF    YCU    DESIRE    A     LIFFERENT    MARKOV    CRITERIA,    TYPE    THE 
INTEGER    VALUE. 

IF    YCU    DESIRE    THE    DEFAUIT    VALUE,    TYPE    "0"     (ZERC) 

• 

C 

DO  YCU  DESIRE  TC  SYNTHESIZE  A  STABLE  FILTER  (OR  REGULATOE) 
BY  EESIAEIIIZING  THE  ORIGINAL  SYSTEM? 

(KCTE:WORKS  FCF  FILTER  OR  REGULATOR  BUT  NOT  FCR  EOTH 
IN  THE  SAME  RUN.) 
TYPE  "YES"  CR  "NO". 


CO 


yes 


DC    YCU    DESIBE    TC    PRINT    THE    EULER-LAGRANGE    EIGENSYSIEM 
PRICE    TO    DECC2ECSITICN     (FOR    CHECKING    THE    PROGRAM)? 
TYPE    "YES"    CR    "NO". 

ECWEE    SPECTRAL    DENSITY     (PSD)     OPTION    1     : 

CITICN    1    —    COMEOTE    THE    PSD    OF    THE    OUTPUTS    AND/CR    THE 
CONISCLS    OE    TEE    CONTROLLED    SYSTEM    WEEN 
FORCED    EY     EROCESS    AND    MEASUREMENT    NCISE. 
(NOTE:     ECTH    A    REGULATOR    AND    A    FILTER    MUSTEE 
RESIDENI    IN    THE    PROGRAM    TO    USE    IHI S    CPTICN.  ( 
CEIICN    2     —    SAKE    AS    OETICN    1     ABOVE    BUT    ONLY    PRINT    TEE 
RESIDUES     CF    EACH    TRANSFER    FUNCTION 
USEE    IN    THE    ESD    COMPUTATION. 

37 


CE1ICK  3  —  NOT  EESIRED. 

SELECT  AN  CFTION;  1,  2,  OR  3, 


EC  YCL  DESIRE  EEGULATQE  SYNTHESIS  ONLY? 
TYPE  "YES"  CE  "NO". 
y9s 

ENTIR  THE  #  OF  STATES  (NS)  OF  THE  SYSTEM  MATRIX 
(iipii- MATRIX)  . 

m 

2 

ENIFE  TEE  #  OF  CONTFOLS  ( NC)  OF  THE  CONTROL  SYSTEM  MCEEI 
<"G"-MATEIX) . 

1 

ENIFB  THE  ft  OF  MEASUREMENTS  OR  OBSERVATIONS  (NO)  OF  THE 
("E"-KATEIX) . 

• 

2 

ZNTZF    TfcZ     3    OF    FEOCESS    NOISE    SOURCES     (NG)     OF    THE 

("GAKea"-MATaix) . 
c 

FIAG/FAFAMETER    SETTINGS    FOB    THIS    RUN    ARE    AS    FOL1CHS: 
IOL       IC       IE      ISS       IM      ITF1        ITE2       ITF3       IFDEW       IE       IEEEUG 

10COCO  0  0  0  01 

ISSI       IDSTAE      IPSD       IYU      INCSM       IEEG       NS       NC       NOS       NG 
0  C  0  C  0  12         12         0 

ORDEE    CE    SYSTEM    =       2 
NUMEEB    CF    CONTROLS     =       1 
""  NUMEEB    CF    CBSER VATIC  US    =       2 

NUMEEE    CF    FEOCESS    NCISE   SOURCES    =      0 

ENTER    THE    SYSTEt    MATRIX       "F"-MATRIX 

DIMENSION    =    #    STATES     (NS)     X    #    STATES     (NS) 
TEE    FLEMENT    F(     1,     1)  = 
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c 

1HE    ELEMENT   F  (     1,    2)= 
1 

IEE    ELEMENT    F(     2,     1)  = 

0 

IEE    ELEMENT    F (    2,    2)= 

C 

THE    SYSTEM    MATRIX       "F"-MATRIX    ... 
CO  1.0CCOO 

CO  0.0 

DC     YCC    WISH    TC    CHMGE    THE    V2LUE    OF    ANY    MATRIX     ELEMENT? 
TYPE     "YES"    CR    "NO". 
CO 

CEEN    LCC?    DYNAMICS    MATRIX F.  . 

O.C  0.1000E+01 

0.0  0.0 

CIEN    LCCP    EIGENV3IUES DET(SI-F).. 

0. 0  :    0. 0  : 

CEEN    LCCP    RIGHT    EIGENVECTOR    MATRIX T.... 

1.0C0OGCE+0O    -1.000CCCD+00 
0.0  2.220U46D-16 

CfEN    LCCP    LEET    EIGENVECTOR    MATRIX T-INV.  . 

1.CCCCCCD+C0      4.5036C0D+15 
0.0  4.5036COD+15 

ENIER    THE     MEASUEEMENT    SCALING    MATRIX       "H"-MATRIX    . 

DIMENSION    =    #    OBSERVATIONS     (NO)     X    #    STATES     (NS) 

TEE    ELEMENT    H(     1,     1)  = 
-> 

1 
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3HE    ELEMENT    H (     1,    2)= 


Ibc    ELEMENT    H(     7<     1)  = 


ro 


1HE    ELEMENT    H (    2,    2)= 


TEE    MEASUREMENT    SCALING    MATRIX       "H"-MATP.IX    ... 
1.CC0CC  0.0 

CO  1.0CC00 

EC    YCU    WISH    TO    CHANGE    THE    VALUE    OF    ANY    MATRIX    ELEMENT? 

TYPE    "YES"    CR    "NO". 


MEASUREMENT    SCALING    MATRIX H.  . 

0.  10COE  +  0  1         0.0 

O.C  0.100CE+01 

ENTER    THE    OUTPUT    MEASUREMENT    COST    MATRIX       "A"-MATRIX 
ElfcEKSION    =    *    CESERVATICNS     (NO)     X    #    CESEEVATICNS     (NO) 
TEE    ELEMENT    A(     1,     1)  = 


THE    ELEMENT    A  (     1,    2)  = 


TEE    ELEMENT    A(     1,    1)  = 


1HE    ELEMENT    A (    2,    2)= 


TEE    CUTPUT    MEAS0EEM2NT    COST    MATRIX       "A"-MATRIX 
25.CCC0C  0.0 

4C 


CO 


0.  0 


CO    YCu    &ISH    TO    C^ANGii    THE    VALUE    OF    ANY    MATRIX 
TYPE     "YES"    CR    "NO". 


IC 


CUTPUT    COST    MATRIX..., A.. 

C25CGE  +  C2         0.0 
0.0  0.0 

EH1IB    THE    CCNTSCI    DISTEI2UTI0N    MATRIX       "G"-MATRIX 

DIMENSION    =    4    STATES     (NS)     X    #    CONTROLS     (NC) 
TEE    ELEMENT    G(     1,    1)  = 


IKE    ELEMENT    G  (    2,    1)  = 


ro 


TEE    CONTROI    DISTRIBUTION    MATRIX       "G"-MATRIX    ... 
CO 

1. CCOOC 
DC    YCC    BISH    TO    CHAKGE    THE    V2IUE    OF    ANY    MATRIX    ELEMENT? 
TYPE    "YES"    CR    "NO".      ( 

ESTER    IHE    CCNTRCI    COST    WEIGHTING    MATRIX      "B"-MAIRIX 

DIMENSION    =    i    CONTECIS     (NC)     X    #    CONTROLS     (NC) 
TEE    ELEMENT    B(     1,    1)  = 


TEE    CONIRCI    COST    SATEIX E... 

1.00000 

DO    YCC    WISH    TO    CHAxNGE   THE    VALUE    OF    ANY    MATRIX    ELEMENT? 
TYPE    "YES"    CR    "NO". 


ro 


TEE  CONTROL  DISTRIBUTION  MATRIX G. 

J.C 

0.  10C0E  +  0  1 
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TEE    CONTROL    COST    HATRIX B. 


EUIEE-IAGRANGE    SYSTEM    MATRIX. 
0.0  1.000CC0D+00      0.0 

0.0  0.0  0.0 

•2.5CCQCCD+C1       0.0  0.0 


0.0 
-1. C0000CD+00 
0.0 


0.0 


0.0 


-1.C0OOOOD+0O   0.0 


EIGEKVaiUES     £ND    EIGENVECTORS    Or    THE    2N    X    2N 
EDIEE-1AGHASGE    SYSTEM    AETER    HQ32 


•1.561 13SD-*-  CO    1.581  139D+00 

•1.56  113SE+C0-  1.  581  13SD  +  00 

U56113SD+C0    1.581139D+00 

1.  58  112SE  +  C0-  1.581  129D  +  00 

•7.42C4U3D-C2  7.168612D-02 
4. 136155E-C3  -2.308245D-01 
•1,154172D+C0  -2. 0683170-02 
•3. 5844C6E-C1    -  3.7 1 5222D-01 


-1.824925D-01    -1. 503482D-01 

-5.032459D-C2    -5. 262675D-0 1 

2.631337D+00    -2. 54 1 22SD-0 1 

-7.517412D-01       9.124627D-01 


EIGENSYSTEM    CF    CI1IMAL    EEGULATOR. 


EIGENVECTORS    ERC2    RGAIN    FEIOR    TO    CNORM 
1.45SS25D-C1    -2  .616313D-03 
2.34S712E-01    -2.266S"J7D-01 

C-LCCE    CPTIMAL    REG.     E-V ALU IS. .. DEI (SI-F«-G*C) 
1.58114E+00,    1.581 14C+00: 


C-ICCP    EIGHT    EIGENVECTOR    HAIBIX M. 

3. 1 6227ED-C1    -3 . 1 6 2 278D-01 
1.0000CCE+CO      0.0 


CCNTECI    EIGENVECTCR    MATEIX 
1.581139D+0Q       1.561 139D+00 


C*M. 
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C-ICCT    CPT.     PEG.     LEFT    E-VECTOR    MATEIX. . M-INV. . 
0.0  1.000CC0D+00 

-3. 162278B  +  C0    -  1  .OOOCCCD+00 

IHE    CEIIKAI    FEEEBACfl    Gall.    CCKTBC1    MATRIX. .. C-BIN V*     _■.:... 
-5.0CCCE+CC      -3.1623E+00 

1BE    CLOSED     LCOP    DYNAMICS    MATRIX F-G*C. . 

0.0  1.000CCCD+00 

-5.QCCCCCD+C0    -3.162278D+00 

ANAIYSIS    COMPLE1E.     EG     YOU    WANT    ANOTHER    RUN? 
TYPE    "YES"    0  5    "KO". 
no 

OPTS2SX    IS    NOW    1EBEI1SATED 

E;    T=C.a2/1.85    14:03:C3 

reccid    off 

END  EECCEEING  OF  TERHINM  SESSION 

C.   EILTIR  SYNTHESIS 

The  following  Kaliran  filter  synthesis  example  was  taken 
from  "Lecture  Notes  on  Advanced  Control  Systems",  by 
Eroiessor  E.J.  Collins  of  the  Naval  Postgraduate  School, 
Monterey  ,Ca. 

This  example  irvclved  determination  of  the  optiial 
filter  gains  of  an  arbitrary  system;  modeled  nearly  identi- 
cally tc  the  previous  regulator  problem. 

In  its  present  configuration,  OPTSYSX  program  sequencing 
reguires  the  design  of  an  optimal  regulator,  prior  to 
performing  any  optinal  estimator  synthesis.  In  crder  to 
comply  with  built-ir  program  sequencing  conventions,  and 
circumvent  program  difficulties  which  may  not  be  specified 
in  the  particular  system  model,  optimal  filter  synthesis  may 
be  accomplished  by  entering  the  identity  matrix  [I]  in  these 
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program  input  sequer.ces  requiring  the  entry  of  as  cutpu~ 
cost  (weighting)  matrix.  although  the  optimal  re flulator 
calculations  may  differ  from  those  expected,  the  optical 
estimator  calculations  will  be  ccrrect  for  the  system  model. 

Examination  cf  the  extensive  program  output  -.r.dicates 
that  the  optimal  filter  gains  are:  -5.0,  and  -SQRT(2.0). 

Ike  full  terminal  session  is  recorded  below,  with  user 
input  i::  1  z « er  ccsq    letters  following  vd.z:.    "?"  . 

reccrc  or 

EEGIN  BECOBEING  CF  TERMINAL  SESSION 
E;  T  =  C.01/0.02  21:49:30 
filedef  C6  term  (recfm  fa  blksize  133 
global  txtlib  fortmod2  mcd2eeh  imsidp  ncnimsl 
lead  cptsjsa  (start 
EXEC C 1IC N  BEGINS... 
OPTSYSX  IS  A  COMPLETELY  INTERACTIVE  OPTIMAL  SYSTEMS  CCETBCL 
EBCGBAH.  IT  Mill  SOLVE  KUBEROUS  CONTROL  PROBLEMS  ON  THE 
ECHCHING  TYPES  CI    SYSTEMS  CONTROL  EQUATIONS: 
XDOT  =  (F)*X  +   (G)  *U  +  (GAM)  *  (W+tfO) 
MEASUREMENT  EQUATION  — 
Z  =  (H)*X  +   (B)  *W  ♦  V 

REGGIATOR  PERFORMANCE  INDEX — 
J  =  1/2  *  INTEGBAL  (Yt*(A)*Y  +  Ut*(B)*U)ET 
STATI  FEEDEACK  GAIN  DEFINITION— 
U  =  -  (C)  *x 
CO  YOU  HISE  TO  CONTINUE?   TYPE  "YES"  OR  "NC". 


yes 


—  EAIA  ENTRY  — 
AITHCGGH  OPTSYSX  IS  SPECIEICALLY  DESIGNED  TO  READ 
III  MATRIX  EATA  INTERACTIVELY,  SEVERAL  ALTERNATE 
KEIHCDS  ARE  AVAIIABL2  TC  USEES: 

METHOD  1--THE  "F","G",  AND  "GAMMA"  MATRICES 
MAY  BE  E-EAD  FRCM  SEPARATE  DATA  FILES. 
MITHCD  2--THE  "F","G",  AND  "GAMMA"  MATRICES  MAY  EE 
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EXP1ICI1IY    DEFINED    WITHIN    SDBEOOTINE    "SETUP". 
(NOTE:     IN    E  IT  EEB    CASE,    THE    USER    SHOULD    OBTAIN    A    CGEY 
CF    THE    PEOGRA2!    LISTING    AND    EXAMINE 
THE    EXAMPLES    CONTAINED    IN    S/S    "SETUP".) 
EC    SOU     WISH    1C    CONTINUE?       TYPE    "YES"    CE    "NO". 
yes 

EC    SOO    WISH    TO    IKPUT    THE    »FHf    "G",     ANE    "GAMMA" 
HiTEICES    FECM    SUBBOOTINE    "SETUP"    IAW    THE 
METHOD    DESCEISED    CN    THE    PREVIOUS    SCREEN? 
TYPE    "YES"    OR    "NO". 


EO 


no 


GENERAL    CPISYSX    OPTIONS: 
CETIGN     1    --     SYSTEM    ANALYSIS    WITHOUT 

CEEN-LOCP    EIGENSYSTEM    CALCULATIONS. 
CETION    2    —    SYSTEM    ANAIYSIS    WITH    OEEN-LOOE 

EIGENSYSTEM    CALCULATIONS. 
CETION    3    —    CEEN-LOCE    EIGENSYSTEM    FOUND 
AND    PROGRAM    TERMINATES. 
("F"-£AT£IX    ENTRY    EOLLOWS    IMMEDIATELY.) 
CETION    4    --    MCEAL    DISTRIBUTION    MATRICES    CCKEUTEE 
WITHOUT    FILTER    OR    REGULATOR    SYNTHESIS 
CB    STEADY-STATE    ANALYSIS. 
SELECT    AN    OPTION:     1,2,3,     OR    4. 


EO    YCU    DESIRE    RMS    VALUES    OF    STATE    AND    CONTROL? 
TYPE    "YES"    Cfi    "NO". 

CETSYSX    LC.E/CLASSICAL    OPTIONS: 
CETION    1     —    OETIMAL    FILTER    AND/OR    REGULATOR 

SYNTHESIS    WITH    NO    EXTERNAL    "C"    OR    "K" 

MATRIX    INPUT. 
CETION    2     —    OPTIMAL    EILTER    AND/OR    REGULATOR 

SYNTHESIS    WITH    EXTERNAL    "C" 

MATRIX    INPUT. 
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no 


no 


OPTION    3    --   OPTIMAL    FILTER  AND/OR    REGULATOR 

SYNTHESIS    WITH  EXTERNAL    "K" 

MATRIX    INPUT. 

CPTION    4     --    CPTIMAI    FILTER  ANE/OB    REGULATOR 

SYNTHESIS    WITH  EXTERNAL    "C"    ANE    "K" 

MATRIX    INPUT. 

SELECT    AN    OPTION:     1,    2 ,    3,  OR    a. 


EC    ICC    WISH    TO    EETERMINE    THE    STEADY-STATE    RESPONSE 
FOE    A    CONSIA81    BIST  USE ANCZ? 
TYPE    "YES"    CR    "NO". 

EO    YOU    WISH    TO    EETERMINE    THE    MODAL    DISTRIBUTION 
£NC    GAIN    MATRICES? 
TYPE     "YES"    CR    "NO". 

CPEN-ICC?    IFANSEER    FUNCTICN    OPTIONS: 
CPIICN    1     —    NO    CPEN-LOOP    TRANSFER    FUNCTIONS    CCMFUIEE, 
CPIICN    2     --    POIES,    RESIEUES,     AND    ZERCS    COMPUTEE. 
CPIICN    3    —    ONLY    POLES    AND    ZEROS    COMPUTED. 
CPIICN   4     —    CNIS    PCLES    ANE    RESIDUES    COMPUTED. 
SELECT    AN    OPTION:     1 ,    2,    3,    OR    4. 


KCISE    TRANSFER    FCNCTIGK    OPTIONS: 

CPTION    1    —    NO    NOISE    TRANSFER    FUNCTIONS    COMPUTEE, 
CPTION    2    —    POLES,    RESIDUES,     AND    ZERCS    COMPUTED. 
CETION    3    --    ONLY     POLES    AND    ZEROS    COMPUTED. 
CPTION    4    --    ONLY     ECLES    AND    RESIDUES    COMPUTEE. 
SELECT    AN    CPTION:     1,    20    3,    OR    4. 


CCMFENSATOR    TRANSFER    FUNCIICN    OPTIONS: 

CPTION     1    --    NC    COMP .    TRANSFER    FUNCTIONS    COMPUTEE. 
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CETICN    2    —    £CLES,     EESIDUES,    AND    ZEROS    COMPUTED 
CPTION    3    —    CNLZ    POLES    AMD    ZEROS    COMPUTED, 
CPTION    U    —    CMY    POtES    AND    RESIDUES    COMPUTED, 
(NOTE:    A    CCMPENSATOB    TRANSFER    FUNCTION    ZkZ    Z 
CCfclUTED    CNLY    IE    BOTH    A    REGULATOR 
ANE    EILTEE    ABE    SYNTHESIZED 
ANC/CE    INEUT.) 
SELECT    AN    CETION:     1,    2#    3,    OR    4. 


EO 


7 
1 

KILL    A    FEED-FORUED    DISTRIBUTION    MATRIX 
"I"    -    MATRIX       EI    INPUT    ? 

TYPE    "3ES"    OE    "NC". 

THIS    CETICN    DETSRMISES    THE    CEITERIA    FOR    EECIDING    WHEN 

A    HJJBKCV    EARAMETER    IS    ZERC-IEE    MARKOV    PARAMETER 

INEICA1ES    THE    CRDEF    OF    THE    NUMERATOR    POLYNOMIAL    OE    EACH 

TEISSIER    FUNCTION. 

ALL    "N"    ZEEOS    CF    THIS    POLSNCKIAL    ARE    ERINTED   OUT    AND 

THIS    IEST    TELLS    HOW    MANY    EXIEA    ROOTS    EXIST    AT    Z    =    0. 

LESS    IKAN    10.0**  (-IE)     IS    CONSIDERED    ZERO. 

THE    EEEACLT    VALUE    CE    THIS    PARAMETER     (IE)     IS    6. 

IN    CTHEE    WORDS,    IE    =    1.0E-6. 

IF    HOC    DESIRE    A    DIIEEEENT     MAFKCV    CRITERIA, 

TYEE    TEE    INTEGER    VAIUE. 

IF     SCU    DESIRE    THE    EEFAULT    VAIUE,    TYPE    "0"     (ZERO) 
•j 

C 

DO    YCU    EESIRE    TO    SYNTHESIZE    A    STABLE    FILTER     (OR    REGULATOE) 
BY    DESTA3IIIZING    THE    ORIGINAL    SYSTEM? 

(NCTE:WCRKS     EOR    EILTSR    OR    REGULATOR    BUT    NOT    FOR    ECTH 
IN    THE    SAME    BUN.) 
TYPE    "YES"    CR    "NO". 
re 
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r.o 


EC    iCU    DESIFE    TC    PRINT    THE    EULER-LAGR ANGE    EIGZNSYSTEM 
EBICB    TO    DECOMPOSITION     (POii    CHECKING    THE    PROGRAM)  7 
TYPE     "YES"    CH    "NO". 

ICSZB    SPECTRAL    EZK3ITY     (PSD)     OPTION    1     : 

CPTICN    1     —    COMPOTE    THE    PSD    OF    THE    OUTPUTS    AND/CP 
THE    CONTROLS    OF    IHE    CONTROLLED    SYSTEM 
WHEK    EORCEC    EY    PROCESS    AND    MEASUREMENT 
NOISE.        (NOTE:     EOIii    A    REGULATOR    AND    A 
FILTER    MUST    EE    RESIDENT    IN    THE    PROGRAM 
TO    USE    THIS    CPIION.) 

CPIICN    2    —    SAMI    AS    OPTION    1     ABOVE    BUT    ONLY    PBINT    THE 
RESIDUES    OF    EACH    TRANSFER    FUNCTION 
USEE    IN   THE    PSD    COMPUTATION. 

CPTICN    3    —    NOT    EESIRSD. 

SELECT    AN    CPTICN:     1,    2,    OR    3. 


no 


EC  YCU  DESI3S  REGULATOR  SYNTHESIS  ONLY? 
T^PE  "YES"  CR  "NO". 

ENTER  IHE  #  OF  STATES  (NS)  OF  THE  SYSTEM  MATRIX 
"f "-MATRIX  . 


OIER  TEE  #  OF  CONTROLS  (NC)  OF  THE  SYSTEM  MODEI 
"G"-MATRIX  . 


ENTIR  THE  #  OF  MEASUREMENTS  OR  OBSERVATIONS  (NO) 
"H"-MATRIX  . 


ZNIIE  THE  *  OF  PEOCESS  NOISE  SOURCES  (NG) 
"GAMM2"-MATRIX  . 
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7 

C 

FIAG/EflEAMETEB    SETTINGS    FCF    THIS    RUN    ABE    AS    FOLLOWS: 
IOL       IC       IE      ISS       18      III1       II 12      ITF3      IFDFW      IE       IEEEUG 

G  0  C         0  C  0  0  0  0  0  0 

ISET       IESTAE      IPSD       1X0      INORH       IEEG       NS       NC      liO  3       SG 
0C  0C0  02110 

oar  if  of  system  =     i 

NOME  IS    C?    CONTROLS    =       1 

80ME1B    CI    CBSEBVATICNS    =       1 

NUHEEE    CF    EEOCESS    NCISE   SOURCES    =      0 

INTEE    THE    SYSTEM    MATRIX       "F"-MATRIX 

DIMENSION    =    #    STAIES     (NS)     X    #    STATES     (NS) 
TEE    ELEMENT    F(     1,     1)  = 


3BE    EIEMENT    F (     1,    2)= 


TEE    ELEMENT    r(     2,     1)  = 


THE    ELEMENT    F (    2,    2)= 


TEE    SYSTEM    MATRIX       "F"-MATRIX    ... 
CO  1.0C000 

CO  0.0 

DO    XCt    WISH    TO   CHASGE    THE    VAIUE    OF    ANY    MATRIX    ELEMENT? 
TYPE    "YES"    CE    "NO". 


EO 


CIEN    LCCP    DYNAMICS    MATRIX F, 

0.0  Q.10QCE+01 


US 


O.C  0.0 

EMEB    THE    MEASOEEHENT    SCAII8G    MATRIX       "H"-M  AT?.  I  ."<     . 
EIEEKSIOK    =     I    CESER7ATICBS     (NO)     X    #    STATES     (NS) 
TEE    IIEMENT    H{     1,     1)  = 


1BE    E1E8ENT    H {     1,    2)= 


TfcE  HEASUBEaENT  SCALING  KATEIX   "H"-HATRIX  

1.CCGCC      0.0 
EC  YCD  WISH  TO  CHISGE  THE  V2IUE  OF  ANY  MATRIX  EIEfiENl? 
TYPE  "YES"  CE  "NO". 


3!0 


MEASCEEKENT    SCAIIhG    HATilX H.  . 

0.1CC0E+01         0.0 

ENTER     IHE    OUTPUT    MEASUREMENT    COST    MATRIX       "A"-MATEIX 
EIMEl^SION    =    *    CESERVATICNS     (NO)     X    #    OESEEVATICNS     (NO) 
1EI    ELEMENT    A(     1,     1)  = 


IHE    CCIPUT     KEASCFEMENT    CCST    MATRIX       "^"-MATRIX    ... 
1.CC00C 

EC    YCU    WISH    TO    CHANGE    THE    VALUE    Ox     ANY    MATRIX    ELEMENT? 
TYPE    "YES"    CR    "NO". 


EO 


CCTPCT    COSI    CATEI2 A.. 

0.  10C0E  +  Q  1 

ENTER    THE    CCNTBCI    DISTEIEUTION    MATRIX       "G"-MATRIX 

DIMENSION    =    t    STATES     (NS)     X    #    CONTROLS     (NC) 
TEE    ELEMENT    G(     1,    1)  = 


5C 


yes 


lit    ELEMENT    G(     2,     1}  = 


THE    CCSTaOI    DIST2IB0TI0N    MATEIX       MG"-MATEIX    ... 

C.  C 
0.0 
DC    YCC    WISH    TC    CHAKGE    THE    V£LUE    OF    ANY    MATEIX    ELEMENT? 
TYPE     "YES"    CE    "NO". 

INTEE    IKE    BCW    N0E2EE   OE    1BE    ELEMENT    TO    Bl   CHANGED. 


CO 


EN1EB  THE  CCLUMS  NUKBEE  CE  THE  ELEMENT  TO  BE  CHANGED 


THE  ELEMENT  G(  2,  1)  = 


IKE    CCNTBOI    DISTRIBUTION    MATEIX       "G"-MATRIX    ... 
CO 

1.  ccooo 

DC  YCC  WISH  TC  CHASGE  THE  VALUE  OF  ANY  MATEIX  ELEMENT? 
TYPE  "YES"  CE  "NO". 

ESTIB  IKE  CCNTSCL  COST  WEIGHTING  MATEIX   "B"-MAIBIX 

DIMENSION  =  #  CONIFCIS   NC   X  9    CCNTEOLS   NC 
THE  ELEMENT  B (  1,  1)= 


TKE  CCKTBCI  COST  KATEIX B... 

1..CC0CC 
DC  YCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATEIX  ELEMENT? 
TYPE  "YES"  CE  "NO". 


no 


51 


TEE    CCNTBOI    DISTSIEUTION    MATRIX.... G.  . 

0.  10C0I+0  1 

1HS    CClilhOL    COST    ZA'IRll B.  . 

0.  1CCGE+G1 

EIGEKS2STEM    CF    CETIMAL    EEGULATOR. 

C-LCCF    CFTIMAL    SEC    E-V  AIOES.  -.  DEI  (SI-F+G*C)  .  • 
-7.071C7E-G1,    7.07107E-01: 

C-IOCE    SIGHT    EIGISVECTOB    MATRIX M 

-7. 07  1066E-01    -7.G71C66D-01 

1-CCCCCCD+CO      0.0 

CCNTBCL    EIGENVECTOR    MATRIX C*M.. 

-7.C71066D-01       7.C71068D-01 

C-LCCP    CPT.     BEG.     IEFI    E-VECTOR    MATRIX. . M- IN V . . 
CO  1.000CCOD+00 

-1.41«21<1E+C0    -1  .000CCCD+00 

THE    CiTIKAI    FEEDBACK    GAIN    CCNTEOL    MATRIX C=BINV*GT*S 

-1.0CCCE+00      -1.4142E+Q0 

THE    CLOSED    LCOP    DYNAMICS    MATRIX F-G*C.  . 

0.0  1.000CCCD+00 

-1.0CCCCCD+C0   -1  .4142140+00 

ANALYSIS    COMPLETE.     EO     YOU    WANT    ANOTHER    RUN? 
TYPE    "YES"    OB    "NO". 
no 

OPTSYSX    IS    NOW    TEBMINATED 

B;    T  =  C.5V2.84    15:36:49 

ieccid    off 

END  BECCFEING  OF  TERMINAL  SESSION 


E.       E2AMELE    OF    PSOGEAfi    FAILOEE 


The    fcllcwin 
during   regulator 


pathological    example      ci    program 


:a  i_  ure 


synthesis    was 


taken    fro  a; 


<z     <J  C  U  'L  3  a  a. 


Guidance  anc  Control,  Vol. 3,  No. 2,  pp. 190-192,  March-April 
1980. 

Ir  -tis  example,  the  choice  of  the  quadratic  indsx  value 
was  tie  factor  promoting  program  instability;  leading  tc 
eventual  program  failure  in  subroutine  HQE2.  Ihe  calculated 
regulator    gains    of    -5.1,    and    -3.1     (pa.    63)     ar^  2.21   correct! 

With  a  'slight*  acdif icaticn  of  the  ccst  matris  from  a 
previous  value  cf  4.0000  to  a  new  value  of  4.0001,  the 
program  was  run  a  secend  time.  Failure  did  net  occur  en  the 
second  run,  anc  the  new  calculations  (pa.  68)  indicate 
filter  gains  of  -2.0,  and  a  "small"  residue  of  3. 19D-14 
(essentially  zero) .      These    are   the   correct    values. 

This  example  feints  cut  one  possible  method  cf 
ccrrectirg  certain  program  failure  modes,  should  they  occur 
during   execution. 

Ire  full  terminal  session  is  recorded  below,  with  user 
input    in   lower    case    letters    following   each   "?"   . 

Eclicwirg  the  prcgram  failure  example,  -hat  pcrticn  of 
the  repeated  terminal  output  was  deleted  up  to  the  point 
where    program   execution   of    the    second   run   begins. 


record   en 

E2GIN  EECC5EING  CF  TERMINAL  SESSION 

E;  T  =  0.01/0.02  21:49:30 

filedef    C6    term     (recfm   fa  blksize    133 

global   txtlib   fortmoc2    mcd2eeh   imsldp   ncnimsl 

lead    cptsysx    (start 

EXECUTION    EEGINS... 
OFTSYSX    IS    A    COMPLETELY    INTERACTIVE    OPTIMAL    SYSTEMS    CCKTECL 
ESOGFAM.    IT     Bill    SOLVE     KOMERCUS    CONTROL    PROBLEMS    ON    TEE 
ECLLOWING    TYEIS    OF    SYSTEMS    CONTROL    EQ0ATIONS: 

53 


yes 


yes 


no 


XDOT    =     (F)*X    ♦      (G)*U    ♦     (GAM)*(W  +  W0) 
HEASCREHENI    EQUATION — 
Z    =     (H)*X   ♦      (D) *W    +    V 
REGULATOR   P  ERFCRMANCE    INDEX— 
J    =    1/2    *    INTEGRAL     (Y    *  (A)  *Y    ♦    U    *<B)*U)ET 
STATE    FEEDBACK    GAIN    DEFINITION — 
U    =    -  (C)  *X 
DO    YCO    WISH    TO    CONTINUE?       TYPE    "YES"    CH    "NO". 

—  EAT  A    ENTRY  — 
AITECUGH    OPTSYSX    IS    SPECIFICALLY    DESIGNED    TO    HEAD 
All    MATRIX    DATA    INTERACTIVELY,    SEVERAL    ALTERNATE 
KITECES    ARE    AVAILABLE    TO    OSERS: 

METHCD    1--THE    ««F"#"G«,     AND    "GAMMA"    MATRICES 
MAY    BE    BEAD    FRCM    SEPARATE    DATA    FILES. 
EETHCD    2— THE    "F'V'G",     AND    "GAMMA"    MATRICES    MAY    EE 

EXPLICITIY    DEFINED    WITHIN    SUBROUTINE    "SETUP". 
(NOTE:    IN    EITHER    CASE,    THE    USER    SHOULD    OBTAIN    A    COPY 
OF    THE    EROGRAM    LISTING    AND    EXAMINE 
THE    EXAMPLES    CONTAINED    IN    S/R    "SETUP".) 
EC    YOU     WISH    IC    CONTINUE?       TYPE    "YES"    CR    "NC". 

CO    YCU    WISH    TO    INPUT    THE    "F",    "G",     AND    "GAMMA" 
MATRICES    FFCM    SUBROUTINE    "SETUP"    IAW    THE 
METHOD    DESCRIBED    CN    THE    PREVIOUS    SCREEN? 
TYPE    "YES"    OB    "NO". 

GENE5AL    OPISYSX    OPTIONS: 
CPTION     1    —    SYSTEM    ANALYSIS    WITHOUT 

CPEN-LOCP    EIGENSYSTEM    CALCULATIONS. 
CPTION    2    —    SYSTEM    ANALYSIS    HUH    OPEN-LOOP 

EIGENSYSTEM    CALCULATIONS. 
CPTION    3    —    CPEN-LOCP    EIGENSYSTEM    FOUND 

AND    PROGRAM    TERMINATES. 
("F"-MATRIX    ENTBY    FOLLOWS    IMMEDIATELY.) 
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yes 


EG 


eo 


CPIION  4  —  2CEAL  DISTSIEUTIQN  MATRICES  C08PUIEE 
SITHOUT  FILTER  OH  REGULATOR  SYNTHESIS 
Cr  STEAEY-STATE  ANALYSIS. 
SELEC1  AS  OPTION:  1,2,3,  CR  4. 


EG  iCC  DESIRE  RES  VALUES  CF  STATE  AND  CONTROL? 
TYPE  "YES"  CR  "NO". 

CPTSYSX  LQB/CLASSICAL  OPTIONS: 

CPTION  1  —  OPTIMAL  FILTER  ANE/OR  REGULATOR 

SYNTHESIS  WITH  NO  EXTERNAL  "C"  OR  "K" 

MATRIX  INPUT. 

CETION  2  —  OPTIMAL  FILTER  AND/OR  REGULATOR 

SYNTHESIS  WITH  EXTERNAL  "C" 

MATRIX  INPUT. 

OPTION  3  —  CPTIMAI  FILTER  ANE/OR  REGULATOR 

SYNTHESIS  KITH  EXTERNAL  "K" 

MATRIX  INPUT. 

CFTION  4  —  OPTIMAL  FILTER  AND/OR  REGULATOR 

SYNTH FSIS  WITH  EXTERNAL  "C"  ANE  "K" 

MATRIX  INPUT. 

SELECT  AN  CETION:  1,  2,  3,  OR  4. 


EO  YOU  WISH  TO  EFTERMINE  THE  STEADY-STATE  RESPONSE 
FCB  A  CONSTANT  DISTURBANCE? 
TYPE  "YES"  CR  "NO". 

EC  YCU  WISH  TO  EETERMINE  IHE  MODAL  DISTRIBUTION 
ANE  GAIN  MATflCES? 
TYPE  "YES"  CR  "NO". 

CFFN-LCOP  TBANSIFR  FUNCTION  OPTIONS: 
CriICN  1  —  NO  CPEN-LCCP  TRANSFER  FUNCTIONS  COMPUTEE. 
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CEIICS  2  —  POLES,  RESIDUES,  AND  ZEROS  COMPUTED. 
CHICK  3  --  ONi'i  POLES  AND  ZEROS  COMPUTED. 
CHICS  4  --  CNLY  POLES  AND  RESIDUES  COMPUTED. 
SELECT    AN  CPTION:  1,  2,  3,  OS  4. 


SCISE  TRANSFER  JUNCTION  OPTIONS: 

CZ-TICN  1  --  KC  NOISE  TRANSFER  FUNCTIONS  COMPUTED 
CPTION  2  —  POLES,  RESIDUES,  AND  ZEROS  COMPUTED. 
CPTION  3  --  CNLY  ECLES  AND  ZEROS  COMPUTED. 
CPTION  4  —  OHLY  POLES  AND  RESIDUES  COMPUTED. 
SELECT  AN  CPTION:  1,  2,  3,  OR  4. 


CCMEENSATOR  TRANSFER  FUNCTION  OPTIONS: 

CPTION  1  —  *C  COMP.  TEANSFER  FUNCTIONS  COMPUTED. 
CPTION  2  —  ECLES,  RESIDUES,  AND  ZEROS  COMPUTED. 
CPTION  3  —  CM*  POLES  AND  ZEROS  COMPUTED. 
CPTION  4  --  CNLY  POLES  AND  RESIDUES  COMPUTED. 

(NOTE:  A  COMPENSATOR  TRANSFER  FUNCTION  CAN  EE 
COMPUTED  CNLY  IF  BOTH  A  REGULATOR 
2*D  FILIEE  ARE  SYNTHESIZED 
AND/OR  INPUT.) 
SELECT  AN  CPTION:  1,  2,  3,  OR  4. 
1 

1 

WILL    A    FEED-FORWARD    DISTRIBUTION    MATRIX 
("D"    -    MATRIX)      EE    INPUT    ? 

TYPE    "YES"    OR    "NO". 
EO 

£0    YCU    EISIEE    TO    SYNTEESIZE    A    STABLE    FILTER     (OR    REGULATCR) 
BY    DESTABILIZING    THE    ORIGINAL    SYSTEM? 

(NCTE:WORKS    FOB    FILTER    OB    REGULATOR    BUT    NOT    FCR    ECTH 
IN    THE    SHE    RUN.) 
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TYPE    "YES"    CE    "NO". 
BO 

DC    SOU    DESIRE    IC    raliJT    THE    EULER-LAGRANGE    EIGENSYSIEM 
EBICR    TO    DECCJiFOSITIOS     (BOH    CHECKING    THE    EHOGEA8)? 
TYPE     "YES"    CE    "NO". 
no 

ECBEB    SPECTBAI    EENSITY     (ESD)     OFTION    1     : 
CETIC*     1    —    COMPUTE    TEE    PSD    OF    THE    OUTPUTS     AND/OR    THE 

CONTBOLS    CF    THE    CONTROLLED    SYSTEM    WHEN    FCECED    BY 
PROCESS     4SD    MEASUREMENT    NOISE.        (NOTE:     ECTK    A 
REGULATOB    AND    A    FILTER    MUST    BE    RESIDENT    IN    THE 
PROGRAM    TC    USE    THIS    OPTION.) 
CETICK    2    —    SAME    AS    CETION     1    AEOVE    BUT    ONLY    PRINT    THE 
RESIDUES    CE    EACH    TRANSFER    FUNCTION 
USED    IN    TEE    PSD    COMPUTATION. 
CPIICN    3    —    NOT    EESIEED. 

SELECT    AN    CETION:     1,     2,    OR    3. 


"5 


yes 


EC  IOD  DESIRE  REGULATOR  SYNTHESIS  ONLY? 
TYPE  "YES"  CR  "NO". 

ENTER  THE  *  OF  STATES  (NS)  OF  THE  SYSTEM  MATRIX 
<"F"-KATRIX) . 


ENTEE  THE  #  OF  CCNTROLS  (KC)  OF  THE  SYSTEM  MODEL 
<"G"-MATRIX) . 


ENTER  THE  #  OF  KIASUREKENIS  OR  OBSERVATIONS  (NO) 
<"H"-MATRIX) • 


ENTER  THE  #  OF  EBOCESS  NOISE  SOURCES  (NG) 
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("Giifcii!i"-MAIfiIX)  . 

C 

FIAG/EiFAMETEB    SrITINGS    FOB    THIS    SUN    ARE    AS    FOIIC5JS: 
IOL       IC       IB      ISS       IM      ITE1        ITE2       ITF3       IFEEW       IE       ICZEUG 

11C001  0  0  0  00 

1SE1       IDSIAE      IPSO       IYU      INCBM       IREG       NS       NC      NOB       NG 
0C  OCC  12120 

ORDEE    CE    SXSTEM   =       2 

NUMEEE    CE    CONTROLS    =       1 

NUMEEE    CF    CBSERVATIOS    =       2 

NUMEEE    CE     EEOCESS    NC1SE    SOURCES    =      0 

ENTER    THE    SYSTEM    MATRIX     ("F "-MATRIX) 

EIMENSION    =    #    STATES     (NS)     X    #    STATES    (NS) 
THE    ELEMENT    F (     1 ,    1)  = 

c 

TEE    ELEMENT    F(     1,    2)  = 

1 

THE    ELEMENT    F  (    2,    1)  = 

-1 

TEE    ELEMENT    F(     2,    2)  = 

0 

THE    SYSTEM    MATEIX     ("F"-MATRIX)  ..  . 

0.0  1.0CC00 

-1.CCO0C  0.0 

CO    YCU    WISH    TO    CHANGE    THE    VALUE    OF    ANY    MATRIX    EIEMENT? 
1YEE    "YES"    CE    "NO", 
no 
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CEEN  LCCP  DYNAMICS  MATRIX F.  . 

0-C  0.100CL+01 

-o.iocor«-Gi      o.o 

CPEN    LCCP    EIGENVAIfJES DET(SI-E).. 

0.0  ,     1.COO0CH-Q0: 

CPEN    LCCP    EIGHT    EIGENVECTOR    KATfilX I. . .  . 

0-0  -1 .OOOCCCD+00 

1.CCCCCCD+C0      0.0 

CPEN    LCCP    LEFT    EIGENVECTOR    MATRIX T-INV. . 

0.0  1.000CCCD+00 

•1.00COCCE+CO       0.0 

ENIER    THE     MEASUREMENT    SCAIING    MATRIX     ("H"-M ATRIX) . 

DIMENSION    =    #    OBSERVATIONS     (NO)     X    #    STATES     (KS) 
THE    ELEMENT    H(     1,    1)  = 


-1 


TEE    ELEMENT    H(     1 ,    2)  = 


IKE    ELEMENT    H (    2,    1)= 


TEE    ELEMENT    H(     2,    2) - 


TEE    MEASUREMENT    SCALING    MATRIX     ("H"-MATBIX) 

0.0  0.0 

CO  -1.0CC00 

£C  ICO  WISH  TO  CEANGE  IHE  VALUE  OF  ANY  MATRIX  ELEMENI? 

UPS  "YES"  CE  "NO". 


no 
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MEASC5EKENT  SCALING  MATEIX H.  . 

0.0  0.0 

0.C         -0.10  0CE+01 

ECEAI    HIASUBEMEN1    SCALING    MATRIX H(3AH)*T.. 

C-0  O.C 

-1.CGCO00D+OO      O.C 

ENTER  IHE  OUTPUT  MEASUREMENT  COST  MATEIX  (•' A"-MATRIX) 
EIKOSION  =  #  OBSERVATIONS  (NO)  X  «  OBSEBVATICKS  (NO) 
THE    ELEMENT    A(     1,     1)  = 


IE  I    ELEMENT    A(     1,2)  = 


IHE    ELEMENT    A (    2,    1)= 


TEE    ELEMENT    A(     2,    2)  = 


no 


SHE    OUTPUT    EEASOEEMENT    CCS1    MATEIX     (" A"-MATRIX) . . .. 
CO  0.0 

c.o  a.occoo 

EC    YCU    WISH    TO    CHANGE    IHE    VALUE    OE    ANY    MATRIX    ELEMENT? 
TYPE     "YES"    CR    "NO". 


GCIPCI    COST    MATRIX , A.. 

0.0  0.0 

O.C  0.400CE+01 

ENTER    THE    CCNTECL    DISTEIBDIION    MATRIX     ("G"-MATRIX] 

DIMENSION    =    #    STATES     (NS)     X    *    CONTROLS     (NC) 
TEE    ELEMENT    G(     1,    1)  = 
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r.o 


no 


TEE    ELEMENT    G(     2,    1)  = 


TEE    CCNTROI    DISTRIBUTION    MATRIX     ("G"-M ATRIX) . .. 
CO 
1-CCOOO 

EC    YCU    WISH    TO    CHANGE    THE    VALUE    0?    ANY    MATRIX    EIEMENT? 
TYPE     "YES"    CE    "NO". 

ENIER    THE    CCNTBCI    COST    WEIGHTING    MATRIX     ("B"-MATRI2) 

DIMENSION    =    #    CONTBOIS     (NC)     X    #    CONTROLS     (KC) 
THE    ELEMENT    B(     1,     1)  = 


TEE    CONTROL    COST    MATRIX E... 

1.CC00C 

EC  YCU  WISH  TO  CBANGE  THE  VALUE  0?  ANY  MATRIX  ELEMENT? 

IYPE  "YES"  CR  "NO". 

TEE  CCNIROL  DISTRIBUTION  MATRIX G.  . 

0.  0 

0. 1CC0E+01 

MCEAI  CCNTROL  DISTRIBUTION  MATRIX TI*G.. 

1  .CCCOCCD+00 

0.0 


THE    CCNIROL    COST    MATRIX. 

0.  1CC0E  +  01 

CEEN  LCCP  TRANSFER  FUNCTIONS... 

TF  FCR  INPUT  NO.   1  ANE  OUTPUT  NO.   1: 
NC  FINIIE  ZEROS.   TF  GAIN  =   0.0 
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RESIDUES    AT    THE    ECIES; 

E    C    L    E    S  RESIDUES 

R  E  A I  { A )  I M  AG  ( E  ) 

{      0.0       )+J(    1.0C000C)  (      0.0    )  EXP  (A*T)  *COS(B*T) 

(      0.C      )+J  (-1 -OGOO0C)  (      0.0      )       EXP(A*T)  *SIN<B*T) 

II    ECR    IKED3    NO.       1     ASD    OUTPUT    NO.       2: 

OEEES    CE    KUHEBATOB    =       1  T?    GAIN    =    -0.1000D+01 

NUHEBAICR    EIGENVALUES     (INCLUDING    EXTRANEOUS    ZERO    VALUES) 
(  0.0  )+J|  0.0  ) 

(  O.C  ) +J  (  0.0  ) 

RESIDUES    AT    THE    FOIES: 

ECLES  RESIDUES 

REAL  (A)  IMAG  (B) 

(    0.0    ) +0  (     1.000000)  (    -1.C00000)  EXP  (A*T)  *COS  (E*T) 

(    O.C    )  +J  (-1.000000)  (0.0.  )  EXP  (A*I)  *SIN  (E*T) 

EAILUBE    IN    HQE2    0  li    EIGENVALUE    NO.  4 

-1.'96236€C*C0       3.464612D-03    -2 .4S9867D+00  1.508857D  +  00 

3.464836D-03       3.762172D-C2    -1 . 49 1 1 43D+G0  2. 500 1 Q2E+00 

-4.4  15041E-15   -3.208643D-13    -  1 . 962366D+ 00  3.621151D-03 

5.261S45D-11    -1  .267612D-17       3.621125D-03  3.762121D-02 


E1GEKSYSTEM    CF    CE1IMAL     REGULATOR, 


EULEE-LAGRANGE    EQUATIONS    HAVE    A    REAL    EIGENVALUE 
AT    OR    NEAE    ZERO. 

C-ICCE    CETIMAL    REG.     E-V ALUES. . . DET (SI-F+G*C) . . 
0.0  :    O.C  ,-  1.00000D+00: 

C-LCCE    EIGHT    EIGENVECTOR    MATRIX M 

•■7.C586C7D-C1       6.035165D-01 
■7.0833C7E-01       1  .0  00  C  CCD  +  QO 


CCSTSCI    EIGENVECTC3    MATBIX C*M.  . 

-1.il117€1D+00   -1.5C4787D-02 

C~^CCF    (~LT.     BEG,    LZiT    E  — VECTOR.    MATRIX.  •S-INV.  « 
■3.  592CS2D+CQ      2  . 1  6  7££8D<-00 
•2. 5Hli282L+G0      2.5355S2D+00 

THE    CFIIHAI  FEEDBACK    GAIN    CCNIECL    MATRIX C=BINV*G1*; 

5.  1C95E+GC      -3.Q987E+00 

THE    MCDAL    CCKTBOI    GAINS ...C*T.  . 

-3.CS86S6D+00    -5.  1C9451D +  CG 

TEE    CLOSED    LCOF    EYNAMICS    MATRIX F-G*C. . 

0.0  1.000CGCD+00 

4. 109U51D+CO    -3 .098696D+Q0 

ANALYSIS    COMPLETE.     EO     YOU    WANT    ANOTHER    RUN? 
TYPE    "YES"    OB    "NO". 


yes 


yes 


yes 


EC  YCU  WISH  TO  SA*VZ  THE  "F"-MATRIX  FROM  THE  LAST 

FUN  TO  EE  USED  IN  THE  FOLLOWING  RUN? 

NCIE:  THE  MATRIX  WILL  EE  FEDISPLAYED  AT 

TEE  FFCFER  INPUT  SEQUENCE  INTERVAL 

AKD  YCU  WILL  HAVE  THE  CFTION  OF  CHANGING 

INIIVIEUAL  MATRIX  ELEMENTS. 

TYPE  "YES"  OB  "NO". 

CO  SOU  WISH  TO  SAVE  THE  "H"-MATRIX  FRCM  THE  LAST 

FUN  TO  EE  USED  IN  THE  FOLLOWING  RUN? 

NCIE:     IHE    MATRIX    WILL    EE    FEDISPLAYED    AT 

TEE    FECPSR     INPUT    SEQUENCE    INTERVAL 

AND    YCG    WILL    HAVE    THE    CFTION    OF    CHANGING 

INDIVIDUAL     MATRIX    ELEMENTS. 

TYPE     "YES"    OB    "NC". 

EC  YCO  WISH  TO  SAVE  THE  "G"-MATRIX  FROM  THE  LAST 
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BUN  TC  EE  USED  IK  THE  FC1ICWING  RUN? 
KC1I:  IHE  HATBIJ  WILL  EE  BEDISPLAYED  AT 
3HE  FECPEF.  INPUT  SEQUENCE  INTEBVAL 
JKE  YCU  HILL  HAVI  THE  OPTION  OF  CHANGING 
I8DIVIE0AL  CATBIX  ELEMENTS. 

TYPE  "YES"  OH  "NO", 
yss 

Author's    note:    Sine*;   the    same    program   options   are    to 

be    run   again,    with  only   a   change   in   ore 
of    the   cost   matrix    element    values,    the 
terminal  output    was    deleted   up   to    the 
point    where    program   calculations    resume 
in    crder  tc    avoid  redundancy. 

ORLEE    OE    SYSTEM    =       2 

NUMEEE    CE    CONTROLS    =       1 

NUMEIE    CE    CESERVATICNS    =       2 

NUMBER    CF    IROCSSS    NCISE    SOURCES    =      0 

THE    SYSTEM    MATRIX     ("F"-MATRIX)  ... 
CO  1.O0C00 

-1-CCOCC  0.0 

EC    YCU    WISH    TO    CHANGE    THE    VALUE    OF    ANY    MATRIX    EIEMENI? 
TYPE    "YES"    CR    "NO", 
no 

OPEN    LCCF    DYNAMICS    MATRIX F.  . 

0.0  C.100CE+01 

-Q.1CCCE+Q1         0.0 

CEEN    LCCP    EIGENVALUES DET(SI-F).. 

0.0  ,    1  .  C000CE+00: 

CEEN    LCCP    RIGHT     EIGENVECTOR    MATRIX T 

0-0  -1 .OOOCCOD+00 

1.0000CCD+CO      0.0 
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CIIV    LCCP    LEFT    EIGENVECTOR    MATRIX I-INV. . 

0-0  1-OOOOCOD+OO 

-1.0O00CCE+C0      CO 

1EE    MEASUREMENT    SCALING    MATRIX     («H"-MATRIX) .  .  . 
0.0  0.0 

CO  -1.0CC00 

£C    YCU    WISH   TO    CHANGE    THE    VALUE    0?    ANY    MATRIX    ELEMENT? 
TYPE     "YES"    CE    "NO". 
no 

MEASUREMENT    SCALING    MATRIX H.  . 

0.0  0.0 

O.C  -0.100CE  +  01 

ECIAI    MEASUREMENT    SCALING    MATRIX H  (BAR)  *T.  . 

C.C  O.C 

-1.CCOOOGD+00      O.C 

ENIER    THE    OUTPUT    MEASUREMENT    COST    MATRIX     (" A"-MflTEIX) . 

IIMENSION    =    #     OBSERVATIONS     (NO)     X    #    OBSERVATIONS     (NO) 

IES    ELEMENT    A(     1 ,     1)  = 
1 

C 

TEE    ELEMENT    A(     1,    2)  = 


THE  ELEMENT    A(     2,    1)= 

C 

TEE  ELEMENT    A(     C    2)  = 

a. ooo  1 

IHE  CUIPUT    MEASCEEMENT    CCSI    MATRIX     (" A"-MATRIX) . . . 

CO  0.0 

CO  4.0CC10 

IC  YCU  WISH  TO  CEANGE  1BE  VALUE  0?  ANY  MATRIX  ELEMENT? 
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TYPE    "YES"    CB    "NO", 
r.c 

CUTEUT    COST    MATRIX A.. 

O.C  0.0 

0.0  0.400CE+01 

THE    CCNTEOI    EISTRIBUIION    MATRIX     ("G "-MATRIX) .. . 
CO 

1.CC00C 
EC    YCU    WISH    TO    CEAHGE    IHE    VALUE    OF    ANY    MATRIX    ELEMENT? 

TSPE     "YES"    CE    "NO". 
no 

EK1EB  THE  CCNTHCI  COST  WEIGHTING  MATRIX  ("B"-MATRIX) 

DIMENSION  =  #  CONTROIS  (NC)  X  #  CONTROLS  (NC) 
THE  ELEMENT  B  (  1,  1)  = 

• 

1 

TEE  CCNTRCI  COST  MATBIX B... 

1..CCGO0 

IC  YCU  WISH  TO  CHANGE  THE  VALUE  OF  ANY  MATRIX  EIEMENI? 
TYPE  "YES"  CB  "NO". 
no 

THE  CCNIROL  DISTBIBUTION  MATRIX G.  . 

O.G 

0. 1CC0E+01 

ECIAI    CONTROL    DISTBI3UTI0N    MATRIX TI*G. . 

1 .CCCOCCD+00 
0.0 

IHE    CCNIEOL    COST    EATRIX B.  . 

0. 1CC0I+01 

CEEN    LOCP    TRANSFZB    FUNCTIONS... 
TF    FCF    IKEUT    NO.        1     ANE    OUTBUT    NO.       1; 
NC    FINITE    ZEBCS.       TF    GAIN    =       0.0 
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SZS1C0IS    £T    THE    POLES: 
E    C    I    E     S 

RE AI  (A)  IM  AG ( B) 

(      O.C      )+J  (      1  . QOOCCC} 
{      O.C      )  *J  (   -1  .  COOOCG) 


E    E    S    I     D    U 


(       0.0      ) 
(       0.0      ) 


EX?(A*T)*CGS  (E*T) 
EX?  (A*T) *SIN  (E*T) 


T?    FCE    INPUT    NO.        1     £SE    OUTPUT    NO.       2: 


ORE  IE    CF    SOilEBATOB    =      1 


TF    GAIN    =    -0. 1G00D+01 


NUKEEAICE    EIGENVALUES     (INCLUEING    EXTRANEOUS    ZERO    VALUES): 
(  O.C  ) +J  (  0.0  ) 


( 


O.C 


)*J  I 


0.0 


RESIEUES     AT    THE    POIES 

E    C   L    E    S 

REAL  (5)  1MAG(E) 

(       C.C       )+J  (       1 . COOOCC) 

(       O.C       )  +J  (   -1.  COOOCC) 


) 


RESIEUES 


(    -1.000000) 
(      0.0  ) 


EXE(A*I)  *COS  |B*T) 
EXP  (A*T)  *SIN  (B*T) 


E2GESSXSTEM    CF     CETIKAL     EEGCLATOR. 


C-LCCE    OPTIMAL    REG.     E-  V  ALUFS.  .  .  DET  (SI-F+G*C) 
1.005C1E*GC:-9.95  0  12E-0  1: 


C-LCCF    FIGHT    EIGEKVECTOE    MATRIX M... 

7.05336fiE-01    -7 .0 88723D-0 1 
•7.Ce£723D-C1       7.053368D-01 

CCKTECL    EIGENVECTOR    MATRIX C*M.  . 

1.417762D+00    -1  .  4  10691 D+00 

C-LCCE    CPT.     BEG.     LEFT    E-VECTOR    MATRIX. . M-INV, 
•1.M1C6S1D+C2   -1  .4  17762D+02 
■1.U  17762E+C2   -1.4  106S1D+02 
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THE    CfTIHftI   FSEEEACK    GAIN    CONTROL    MATRIX. . .C=BINV*GI*S 
-3.1«7«E-14      -2.000CE+00 

.  .  - C*T.  » 


TEE    CCEA1    CCNTEOI    GAINS 

-2.CCC025D+00      3.1S7U42D-14 

TEE    CLOSED    LCOP    EYNAHICS    MATRIX F-G*C. 

0.0  1 .OOOCCOD+00 

-1.0C000CE+C0   -2.G0QC25D+00 

ANALYSIS    COMPLETE.     EO    YCU    WANT     ANOTHER    RUN? 
TYPE    "YZS"    OR    "NO". 
EC 

CPTSYSX    IE    NO*    TERMINATED 

B;    I=C^63/2.60    23:33:07 

rsccic   cff 

END  EECCFDIKG  OF  TERMINAL  SESSION 
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*•     COSCIGSICNS    SHE    S^COMMENDATIONS 

a.     cociosions 

Although  originally  developed  fox  the  quadratic 
synthesis  ct  controllers  for  rotary-wing  vtol  aircraft,  the 
extensive  modifications  and  enhancements  of  Hall's  original 
work,  coupled  fcith  its  efficient  and  accurate  eigensystem 
solution  routine,  represent  a  powerful  tool  in  the  design  of 
optimally   controlled    systems. 

In  its  present  interactive  form,  OP1SYSX  has  been  trans- 
ferred frci  the  arena  of  high-level  applied  mathematics  and 
numerical  analysis  to  the  level  of  control  system  engineers 
and  students.  It  now  represents  an  even  more  powerful 
educational  tool,  sfcle  to  rapidly  and  effectively  unlock 
many  nisunderstcod  linear  systems  mathematical  relation- 
ships. 

As  ar.  ultimate  evaluation  of  the  computational  abilities 
of  OPTSYSX,  the  program  was  t€sted  using  an  82  X  82  matrix 
cf  aircraft  longitudinal  motion  equations  for  the  VX-29 
experimental  Fighter  aircraft  derivative,  provided  by 
KAS A-I cwar ds. 

For  a  system  of  equations  of  this  magnitude,  all  program 
arrays  were  re-dimensioned  (as  shown  in  Appendix  A) ,  and  a 
2-Megabyte  virtual  machine  size  was  required.  This  system 
was  run  through  the  Medal  Analysis  option  of  OPTSYSX, 
requiring  less  thai  90  seconds  to  lead  the  system  and 
complete   all  oper-lccr   and    modal    analysis    calculations! 

Program  results  exhibited  perfect  eigenvalue  correlation 
with  these  cbtained  from  the  John  Edwards  Control  Program. 
Additionally,  OPTSYSX  provided  complete  longitudinal  medal 
analysis,    previously    unavailable    en   a    system   cf   this   size. 
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It  is  hoped  that  the  use  of  this  interactive  prcgran 
veisicu  fcill  be  encotraged;  and  that  its  expanded  abilities 
will  stimulate  both  ictsrestin  izd  research  on  basic  systems 
ccntrcl    pietisms,   as    sell   as   more   advanced    designs. 

E.       EECCKMENEATICNS 

Based  c  r.  the  results  of  "his  t  h  3  s  i  s »  four  s.  r  f~s.  s  ^  m  e  r  c  e  d 
as    possibilities   for    further   research   and    study: 

1  •      Erogram    Availability 

lbs  use  of  CPTSYSX  and  similar  design  programs 
should  te  encouraged  in  all  undergraduate  and  graduate  level 
courses  involved  in  the  analysis  and  design  of  ccntrol 
systems.  Toward  this  end,  it  is  recommended  that  OPTSYSX  be 
placed  ir  the  ncn-IESL  library  of  subroutines,  makirg  it 
easily   available   to    all    potential   users. 

2  .      Com  cuter   Graphics 

lis  addition   cf  graphical  plotting  routines   tc  the 

program  in  the  time  and   frequency  domain  would  make  CETSYSX 

an  ever  acre   powerful  tool  in  the  design  of  many  optimally 
controlled  systeis. 

3-   Further  Modifications 

Ihe  present  version  cf  the  program  should  te  modi- 
fied to  include  the  CETSYS  5  derivative  input  term  improve- 
ments cf  Lie  [Eef.  3],  and  program  sequencing  during  optimal 
filter  synthesis  shculd  be  examined.  Various  test  runs 
indicate  an  area  of  ccnflict  ic  that  the  program  appears  to 
require  the  design  of  an  optimal  regulator  prior  to 
perfcrairg  any  filter  calculations. 
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? r o era  m    *p d  1  i cat  io n 


cf    Bicicccjcputer  implementation. 
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APPENDIX  A 
OPTSYSX  PROGRAM  LISTING 


£***♦***** *****************************  ********************************* 

c*************  ****************************  ****************************** 
C** **********  ************ 

C**********  OPTSYSX  ********** 

C********  Sy    JOHN    g.     HCEEN  ******** 

C********  ******** 

c********  XHIS    PBCGRAtt    IS    A    COMPLETELY     INTERACTIVE  ******** 

c********  OETIMAL    SYSTEFS    CONTRGl    DSS IG S/S YNTHESI3  ******** 

c********  P5CGRAH    CAPABLE   OP    HANCLING    VEEY    LARGE     (30X80)+  ******** 

C********  SCLTIVARIAEL2    SYSTEMS     CB    LINEAR    EQUATIONS.  ******** 

C********  ******** 

..........  VERSION    1.3  11     BAR    1984  ********** 

C** *********  *  ************ 

£******** ***************************************************  4*********** 

c****************************** ***********  ****************************** 
IMPLICIT    REAL*8  (A-3,C-Z) 

C 

INTEGER  I1HS, ICL , IQ , IR, ISS, IS , ITF 1 , 1 IF2 , ITF 3 , IFDFS , IE , IDE B DG , IS  ST, 
1IPSD.I  Y0,INOEa,NS,NC,NOB , NG ,1 EEG , IDS T AE , IB ET , HHOH , N COL , IS  A F , IS A  a , I 
2SAG,IGAa 

C 

C  LARGE    QRCER    SYSTE?     (62    X    62)     CIHENSICSS- 


C  DIMENSION    ACLJ62, 82)  ,B(4  1  .4  1)  ,EA  (82.  82)  ,CI(82)  ,CB  (82)  ,  CO  (8  2  ,8  2) 

1,8  2)  ,FEGE  (82.  4  1)  ,G  (82.82)  ,GM  (82,3  2)  , 


C  *CMI  (82)  ,C5R(8  2)  ,  FEGC  (41  ,8  2)  ,  FEGE  (82.  4  1)  ,G  (82.82)  rGH  (82,82 

C  *PBO(82,32),aC  (41,41)  ,SZ  (32,  82),  WR  (16  4)  ,  WI  (164)  ,311  (82,32) 

C  *«  2 1(62,  8  2)  ,1/  164,  164)  ,GN  (82,8  2)  ,HO(4  1,82)  ,01  (164)  ,D2  (164)  ', 

C  *Bfl  (164  ,  1  6  4)  rQ  (41,41)  ,GAMj32  ,41)  .iiSOH  B  (82  ,82)  ,  Si  NOR  MI  (82  ,32)   . 

C  *DESTA3  (32), A  A  (61, 6  2)  ,BM  (8  2,  41)  ,CH(41  ,82)  ,D  (41,41)  ,  DSTOP.S  (3  2.8  2) 

C  *JCF(164)  .BBS  (164)  ,AY  (82  ,32)  .BE  (164)  ,  CC  ( 164)  ,  C?  (3  2)  ,  GW ( 164 , 4  1 )  , 

C  *GV  (164  ,4  1)  ,HY  (4  1,  164)  ,HU  (41  ,  164)  ,PRTT  (16,  16)  , DOM  (82,85) 

C  STANDARD    FROGBAP    CIMENSIONS. 


C— - 


DIMENSION  ACL  (32,52)  .3(3  2  ,3  2)  ,EA  (32.  3  2)  ,  CI  (3  2)  ,  CR  (3  2)  .  CQ  (  3  2  ,  3  2)  ,  C» 
II  (32)  . CSR  (32)  ,EEGC(32,32)  ,F3GE  (32,32)  ,G  (32,3  2  ,GM  (32,32)  ,  PRO  (32,  32 
2)  ,  RC  (3  2.  32)  ,SC  (32,32)  ,Wfi{64)  ,  SI  (64)  ,111  (32,32)  ,H2l  (32,32)  ,X  (64,64) 
3,GN(32.32),aO(32,32),D1(6  4)  ,D2(64),RM(64,54)  .  Q  (32,32)  .  GAM  (32.32)  ,« 
4MCHH(32,32)  ,  WNCPMI(32.32)  ,DESTAB(32)  ,AA  (32,32)  ,3M  (3  2, 3  2),  CM  (32,  32) 
~>,D(32,32),DSTCBE(32,32)   ,  JCF  (6  4)  .RES  (64)  ,  AY  (3  2,  32)  ,  3  3  (6  4)  ,CC    6  4)  ,C? 

(32),  G3  (64,64)  ,GV  (6  4,64)  ,  HI  (6  4,64)  ,H  0(6  4,  64)  ,  ?RTT(16,16j  ,  DOM  (32,  32 


_     JV_ 

EQUIVALENCE     (  H  1  1  ( 1 ,  1 )  ,G  B  (  1 ,~)  )  ,     (W  1  1  ( 1  ,  1)  ,  G  V  ( 1  ,  1 )  )  ,      (H  2  1  (  1  ,  1)  ,  HY  ( 1 
_        t'»>)/      (M21(1,1),H0(1,1)) 

CCflMON    /PROG/    10 L,  IQ, 12, ISS, IK,  ITF 1,  ITF 2 , ITF 3 , IFDFW , IE , ID3T AE , I C EB 
1 DG,ISET, IBEG,IFSD,IiU,IN06M 

DATA    I  Y/'  YV,I2/'  »V 

C       SUPPRESS    INDIVIDUAL    UNDERFLOW,     OVESFLOM,     DIVIDE    CHECK,     AND    DECIMAL       = 
C       CCNVEBT    ERRCR    MESSAGES;     PROVIDE    SUMMARY     OF    2RR0RS    ONLY.  = 

CALL    ERHSET     (  2C7  , 25 6  ,- 1  ,  1  , 1  ,  2C  9) 
CALL    SRRSET     (215,256,-1,1) 
C 

C       INITIALIZE    FLAGS. 

ISAF=0 
ISAG=0 
ISAH=0 
IGAM=Q 
TO  CONTINUE 

IBET=0 
ICL=0 
1(3=0 
IB=0 
ISS=0 
13=0 
ITF1=0 
IIF2=0 
ITF3=0 
I?DFW=0 
IE=0 
IDSTA3=0 
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IEE30G=0 
ISZT=0 
IESD=0 
IYO=0 

i:;osm=o 

IHEG=0 

NS=0 

NC=0 

NCB=0 

NG-0 

C SCRN1  - 

20  C.UL    PBTCES     ('CLESCE5    •] 

WRITE     (5,890) 

CALL    3BCEAH     (IANS) 

IF    (  (I  ANS.NE.  IY)  .AND.  (IANS.NE.IZ)  )     GO    TC    30 

GC    TO    40 
30  WHITE     (5,380) 

GC    TO    20 
UO  CONTINUE 

IF    (IANS.EQ.IZ)     GC    TC   560 

C SCRN2- 

50  CALL    PRTC2S     ('CLRSC3N    ') 

WHITE     (5,900) 

CALL    3DCHAR     (IANS) 

IF     (  (IANS. NE.IY)  .AND.  (IANS.  NE.IZ)  )     GC    TC    60 

GO    TO    70 
60  WRITS      (5,380) 

GC   TO    50 
70  CONTINUE 

IF     (IANS.EQ.IZ)     GC    TC    560 

30  CALL    FHTCSS     ('CL2SCEN    ') 

WRITE     (5,910) 

CALL    3DCEAR     (IANS) 

IF     (  (IANS. NE.IY)  .AND.  (IANS.  NE.IZ)  )     GC    TC    90 

GC    TO     IOC 
90  WBIT5     (5,880) 

GO    TO    30 
100  CONTINUE 

IF     (IANS.EQ.IY)     ISET=1 

CALL    FHTC3S     ('CL3SCEK    ') 
WHITE     (5,570) 
CALL    RDINT    (IANS) 
ICL=IANS-1 

IF    (IOL.  EC. 2)     GO    TO     350 
c iq 

CALL    FBTCES     ('CLHSCBN    •) 
110         WRITS     (5,580) 

CALL    3DCEAR     (IANS) 

IF     (  (IANS. NE.  IY)  .AND.  (IANS.  NE.IZ)  )     GO    TO    123 

GO    TO     13C 
120  WHITE     (5,880) 

GO    TO     110 
130  CONTINUE 

IF     (IANS.EQ.IY)     IC=1 

IF     (IANS.EQ.IZ)     IC-O 

IF     (IOL.EQ.3)     GO    TO    200 
C IH 

CALL    F3TC3S     ('CL2SCEN    ') 

iBITS     (5,590) 

CALL    3DINT    (IANS) 

IH=IANS-1 
c 1  ss  — 

CALL    FHTCKS     ('CLRSCEN    •) 
140  9BITE     (5,600) 

CALL    3DCHAR     (IANS) 

IF     f  (IANS. NE.IY)  .AND.  (IANS.  NE.IZ)  )     GC    TO     150 

GC    TO     160 
150  iBITS     (5,880) 

GC    TO     lUO 
160  CONTINUE 

IF     (IANS.EQ.IY)     ISS=1 

IE     (IANS.EQ.IZ)     ISS  =  0 

C IM 

170         WRITS     (5,610) 


73 


CALL    3DCHAR     (IANS) 

IE     ((IANS.N2.  IT)  .AHD.  (IANS.  SE.IZ)  )    GO    TC    180 

GO    TO     190 
180  HHITE     (5.880) 

GO    TO     17C 
190  CONTINUE 

IF     (IANS.2Q.il)     Ifi=1 

I?     (IANS.EQ.IZ)     IS=0 
200  CONTINUE 

IF    (IOL.EQ.3)      1.1=1 
c ITP1 

CALL    FBTCBS     ('CLHSCEN    ') 

HBITE     (5,620) 

CALL    3CINT     (IANS) 

ITF1=I ANS-1 
C              IF    (IOL.EQ.3)     GO    10    2U0 
C ITF2 

CALL    FBTCBS     ('CLESCE-N    •) 

WfilTE     (5,630) 

CALL    3DINT    (IANS) 

ITf2»IAH£-1 
C              IF    (IOL.EQ.3)     GO    TO    2U0 
C ITF3 

CALL    FHTCBS     ('CL3SCSN    •) 

HBITE     (5,640) 

CALL    SDINT     (IANS) 

ITF3=I ANS-1 
c IFDFW 

CALL    FHTCBS     ('CL2SCEN    ') 
210  .BITE     (5,650) 

CALL    2DCEAB     (IANS) 

IF     (  (IANS.  NE.IY)  .AND.  (IANS.  HE.IZ)  )     GC    TC    220 

GO    TO    230 
220         3F.ITE     (5,380) 

GC    TO    21 C 
230         CONTINUE 

IF    (I1HS.EQ.IY)     IFDPW=1 

IF     (IANS.ZQ.IZ)     I?DFW=0 

CALL    FHTCBS     ('CLESCE-N    •) 

HRITE     (5.660) 

CALL    BDHEAL     (ANS2) 

IE=IDI NT  (ANSB) 

IF    (IOL-EQ.3)     GO    TC    300 
C IDSTA3 

CALL    FHTCBS     ('CI3SCSN    •) 
2U0         HBITE     (5,670) 

CALL    3DCHAB     (IANS) 

IF     (  (IANS.  NE.  II)  .AND.  (IANS.  HE.IZ)  )     GC    TC    250 

GC    TO    260 
250  HBITE     (5.880) 

GO    TO    2U0 
260         CONTINUE 

IF    (IANS.EQ.IY)     IESTAB=1 

IF     (IANS.2Q.IZ)     IESTAB=0 

270         HBITE     (5.680) 

CALL    3DCEAR     (IANS) 

IF     (  (IANS. NE.IY)  .AND.  (IANS.  NE.IZ)  )    GO    TO    280 

GO    TO    290 
280         HHITE     (5.880) 

GC   TO    270 
290  CONTINUE 

IF     (IANS.EQ.IY)     IIEBCG=1 

IF    (IANS.EQ.IZ)     IEEBUG=0 
300          CONTINUE 
C IPSO 

CALL    FHTCBS     ('CL2SCSN    •) 

HBITE     (5.690V 

CALL    HDINT     (IANS) 

IFSD=IANS 

IF     (IPSD.EQ.3)     IPSD=C 

IF     (IPSD.EQ.O)     GO    TO    310 
c IYU 

CALL    F3TCBS     ('CLBSCBN    ') 

HBITE     (5,700) 
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310 
C— 

320 


330 

340 


C— - 

35  0 


CALL    3DINT     (IANS) 
IYU=IAN3-1 
IHORH- 

CALL    FRTCflS     ('CLflSCEN    ') 

WRITE     (5,820) 

CALL    RDREAL     (ANSS) 

IHQHM=IDmT(A8Sa) 

IF    (IOL.EC.J)     GC    TO    350 

CALL    PRTCKS     ('CLRSCEN    •) 

WRITE     (5, "710) 

CALL    3DCHA3     (TANS) 

IF     (  (IANS. NE.IY)  .AND.  (IANS.  NE.IZ)  )     GC    TC    330 

GC    TO    340 

WRITE     (5.880) 

GC    10    32C 

CONTINUE 

IF    (IANS.EQ.IY)     IBEG=1 

IF     (IANS.EQ.IZ       IEEG=0 


C 


CALL    PRICKS     ('CLHSCES    •) 

WRITS     (5,720) 

CALL    3DREAL     (ANSR) 

NS=IDI NT  (ANSE) 

IF    (IOL.1Q.2)     GO    TO    360 


HS- 


WBITE     (5,730) 

CALL    RDREAL     (ANSR) 

HC  =  IDINT  (ANSR) 


WHITE     (5,740) 

CALL    3DREAL     (ANSR) 

NC3=IDINT  (ANSR) 


■NOB- 


■SG- 


360 
C 


C 

370 


380 
390 


C 

400 


410 

4  20 
430 


WHITS 
CALL    a 
NG=IDI 
CCNTIN 


(5,750) 
DREAL    JANS2) 
NT  (ANSR) 

UE 


CALL  ? 
WRITS 
WRITS 
WRITE 
1 , IESTA 
WRITE 
WHITS 
WRITE 


N2=2*S 

CALL  I 
1G.GAM, 
2ESTAB, 
3AG,IGA 


FLAG    SETTINGS 

FTC3S     ('CLHSCEN    ') 

6  ,760) 

6  ,770 

6  ,780)      IOL,IQ,IR,ISS ,IE,ITF1,  ITF2,ITF3r IFDFW , IE , IDEE OG , IS ET 
B 
(6  ,790) 

6  ,800)      IE S C, I TO, I  NORM, IF EG, NS  ,NC,NCB,NG 
(6 ,810        KS , ^C , S03,NG 

BEGIN    CALCULATIONS 

S 

NNEE     (NS,NC,N0E,NG,N2,ACL,B,3A,CI,C3,CQ,CWI,CWR,D,FBGC,FEGE, 

Gi1,GN,  HC-D1  ,D2  .PRO  .  BM,3C,C,3C,  WR, WI,W1 1,  W2  1  ,  X  ,  WNCRM  ,  WNO 

AA,flf!,CM,JCi,R£S,  AY  ,3  3  ,  CC  ,CP,  G  B  ,  G  V  ,  H  Y  ,  HU  ,  OSTOfi  E,  IS  AF  ,  IS 

M,IRET,EHTT,NRCW,NCCL) 


EHI.D 

AH,  IS 


IRITE 
CALL    R 

IF    J'1 
GC    TO 

WRITE 

GC    TO 

CCNTIN 

IF     (IA 

IF     (IA 


(5.830) 

DCEJ- 


CONTIN 
IF  (IR 
IF  (IS 
CALL  F 
WRITE 
CALL  R 

GC    TO 
WHITS 
GC    TO 
CONTIN 
IF     (IA 


AR     (IANS) 
ANS.NE.IX)  .  AND.  (IANS.  NE.IZ)  )     GC    TC    380 
390 

i570e80) 

OE 

NS.EQ.IY)     GC    TC    400 

NS.SQ.IZ)     GC    TC   560 

OE 

ET.EQ.  1)  GO  TO  10 
ET.EQ. 1  )  GO  TO  10 
HTCMS     ('CLHSCEN    ') 

(5.840) 

DCHAR     (IANS) 

ANS.NE.IY)  .AND.  (IANS.NE.IZ)  )     GO    TC    420 

43C 

(5  ,880) 
41  C 
OE 
NS.EQ.IY)     ISAF=1 
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IF     (IANS.EQ.IZ)     ISAF=Q 
C ISAH- 

IF     (NOB. EC. 0)     GC    TO    470 

CALL    FRTCMS     ('CLRSC5N    ') 
440  WRITS     (5,  £50) 

CALL    3DCEAR     (IANS) 

IF     (  (I  ANS.NS.IY)  .AND.  (IANS.  NE.IZ)  )     GC    TC    450 

gc  to  4oC 

450  BHITE     (5.860) 

GC    TO     44C 
460  CONTINUE 

IF  (IANS.EQ. IY)  I£AH  =  1 

IF  (IANS.EQ.IZ)  ISAH=0 
470    CONTINUE 
C ISAG- 

IF  (NC.EC-0)  GC  TC  5  10 

CALL    FRTC3S     ('CLRSCSN    •) 
480  WHITS     (5,660) 

CALL    3DCHAR     (IANS) 

IF     (  (I  ANS.NE.  IY)  .AND.  (IANS.  NE.IZ)  )     GC    TC    490 

GC    TO    50C 
490  WHITE     (5,880) 

GO    TO    480 
500         CONTINUE 

IF     (IANS.EQ. IY)     I£AG=1 

IF     (IANS.EQ.IZ)     ISAG^O 
510         CONTINUE 
c IGAH- 

IF    (NG.2C.3)     GC    TC    550 
CALL    FRTCMS     ('CLRSC5N    ■) 


520         WBITS     (5,870) 

CALL    P.DCfcAa     (IANS) 

IF     (  (I  ANS.NE-IY)  .AND.  (IANS.  NE.IZ)  )     GC    TC    530 


GO  TO  540 
530  WHITE     (5,880) 

GC  TO  520 
540  CONTINUE 


IF  (IANS.EQ. IY)  IGAM=1 
IF  (IANS.EQ.IZ)  IGAM=0 
CCNTIN  UE 


550 

GC   TO    10                                                 ' 
C T  EH H IN  ATE 

560         WHITE     (5,920) 
SIC? 

570  FORMAT     r25X,24HGENERAL    OPTSYSX    CPTIO NS : ,// , 1  OX , 3 5  HO PTION    1     —    SYST 

128  ANALYSIS  9 ITHOOT , / , 22X , 3 5HCFEN-LO CP  EIGENSY5TEM  CALCULATIONS.,/ 
2/.  10X, 42HCPTICN  2  —  SYSTEM  ANALYSIS  WITH  OP  EN -LOO? . /, 22X, 25 HEIG EN 
3SYSTSM  CAICULATICFS. ,//, 10X, 39HCFTIO N  3  —  OPEN-LOOP  SIGENSYSTEM  F 
40UND,/,22X,23HAND  FBCGRAM  T E H 2INATES . ,/ , 22X, 3 9 H  "F"-MATRIX  ENTSY  F 
50LL0WS  IMMEDIATELY.  .//  ,  1  OX  ,  4  SfiCPTI  C  N  4  —  MODAL  DISTRIBUTION  MATH 
6ICIS  COMPUTED  ,/ .  2  2X  ,J7H  W  ITH  CUT  FILTEH  CB  REGULATOR  S YN THES IS ./ . 22X 
7,25HOS  STEADY-STATE  ANAL Y SIS.  ,// , 15X , 3 OHSELECT  AN  OPTION:  1,J,J,  0 
8R    4.) 

580  FORMAT     (//, 5X , 46BEC    YOU    DESIRE    RMS    VALUES    OF    STATE    AND    CONTHCI?,// 

1,101. 19HTIPE     "YES"    CR    "NO".) 

590  FCBMAT     < / ,20X  ,  30 HCFTSYSX     LQ B/CLASSIC AL    OPTIO NS : , //, 10X ,4 3 HCPTION    1 

1  —  OPTIMAL  FILTEH  AND/OB  REG UI ATCR, / , 22 X , 37 HS YNT HES IS  WITH  NC  EXT 
2EENAL  "C"  OH  "K"  ,  /  ,  2  2X,  1  3  HM  AT  H  IX  INP  UT  .  , // ,  1  OX  ,4  3  HO  PTION  2  —  OFTI 
3MAL  FILTEH  AND/OH  REGUL ATCR . /  ,  22 X ,27 HS Y NT H ES IS  WITH  EXTERNAL  "C"./ 
4 ,22X, 1  3HMATRIX  IN FUT . ,// ,  10 X  ,  h 2 HCPTI CN  3  —  OPTIMAL  FILTER  AND/OH 
5REGULATOR,/,22X.27HSYNTHESIS  WITH  EXTERNAL  "K" ,/ , 22X , 1 3HM ATBIX  INP 
6UT.,//,  10X,43HCETICN  4  —  OPTIMAL  FILTER  AND/OR  REGU LATO R , /  ,  2 2X , 35 
73SYNTHESIS  WITH  EXTERNAL  "C"  AND  "K"  ./ , 22X , 1 3HMATRIX  INPUT .,//, 1 CX 
8,32HSELECT    AN    CPTICN:    1,     2,     3,    OB    4.) 

600  FORMAT     ( //,  5 X , 5 CH DO    YOU     WISH    TC    DETERMINE    THE    STEADY-STATE    RESPCNS 

1E,/,3X,27EFOR  A  CCNSTANT  CISTUBBANC E ?, // , 1  OX, 1 9HT YPE  "YES"  CB  "NC" 
2.) 

610  FORMAT     (5X,47HEO    YOU    WISH    TO    DETERMINE    THE    MODAL    DISTRIBUTION ,/, 8X 

1.18HA8D    GAIN     2 ATRICES?,// ,  1 0 X  ,  19HTYP E    "YES"    OR    "NO".) 

620  FCBMAT  (//, 5X  ,  36 BCPEN-LOOP  TRANSFER  FUNCTION  OPTIONS :,//. 1  OX . 53 HCP 
1TION  1  —  NO  OFEN-LOCP  TRANSFEB  FUNCTIONS  COMP UTED.  ,// ,  1 0 X , 48 BC PTI 
20N  2  —  ECLES,  RESIDUES,  AND  ZEBCS  C CMP UTED.  ,//, 1  OX , 42 HOPT ICM  3  — 
3  CNLI  POLES  ANE  ZEBCS  CO MPUTEE. ,//,  1  OX , 45 HCPTION  U  —  ONLY  POLES  A 
4ND    RESIDUES    CC MPCTED. ,// , 10 X, 22HSELECT    AN    OPTION:     1,    2,    3,     OR    4.) 

630  FCHMAT     <//, 5 X  ,  22 H NOISE    TRANSFES    FUNCTICN    C PTIONS : , // , 1 6x , 4 9 HOPTICN 
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1  1    —    SO    NOISE    TRANSFER    FONCTICNS    COMPUTED. ,//, 1 0X, 48H0PTI0N    2    — 

2PCLES,     RESIDUES,    AND    ZEROS    COCEDTED.  ,// , 1 0X, 42HOPTION    3    —    ONIY    FO 
3LES    AND    ZEROS    CC K FUT ED.  , //.  1 0 X ,45 HOPTIG N    4    ~    ONLY    POLES    AND    RESID 
4UES    COMPUTED.  ,//,  10X,32HSELECT    AN    OPTION:     T,     2,     3,    OR    4.) 
640  FORMAT    ]// ,  5  X  ,  38HCC  MFEN5  ATOP.    TEANSFEB    FUNCTION    OPTIONS :,//,  1  0 X , 4 9H 

1CETION     l     —    NO    CCMP.    TRANSFER    EONCTICNS    COMPUT  ED  .  ,//  ,  1  OX  ,  4  8  HOPTICB 

2  2  —  POLES,  RESIEOES,  AND  ZEECS  COM EUTED .  ,//,  10 X ,4 2  HO PTI ON  3  —  0 
3NLT  POLES  AND  ZERCS  COMPUTED .  ,//, 10X , 45 HOPTION  4  —  ONLY  POLES  AND 
4  RESIDUES  COMFUTEC. ,//, 15X, 45E  NOTE:  A  COMPENSATOR  TRANSFER  FUNCTI 
50N  CAN  3E,/,22X,33HCCMPUTED  ONLY  IF  EGTB  A  REGULATOR,/ .22 X , 26  HA N C 
6FI1TER  ARE  S Y N Tt ESIZ ED, / , 22X ,  14HAND/CR  INPUT.  ,//, 1 0 X, 32HS ELECT  AN 
7    rF^Tn'i'    1      ~)      ~k      nu\ 

650  FCEMAT     (//'5x'39HWILL    A     FEED-FCBWARD    DISTRIBUTION    M ATE  IX , / , 5X , 25 H 

1"E"    -     MATRIX       EE    INEUT    ? , // ,  1  5 X , 1 9HT Y PE    "YES"    OR    "NO".) 

660  FORMAT     (/,5X,63H    THIS    OPTION    CETERMINES    THE    CRITERIA    FOR    DECIDING 

1WHEH    A    MABKOV,/,3X,53H?ARAMETE2    IS    ZERO-THE    MARKOV    PARAMETER    INDIC 
2ATES    THE    CRD E R  ,/ , 9X . 5UHO F    THE     NUMERATOR    POLYNOMIAL    OF    EACH    TRANSFE 
3R    FUNCTION. ,//,3X,52EALL     "N  "    ZEROS    OF    THIS    POLYNOMIAL    ARE     PRINTED 
40DT    AND,/  .8X.52HTHIS    TEST    TELLS    HOW     MANY    EXTRA    ROOTS    EXIST    AT    Z    = 
50. ,/,3X,4lHL2SS    THAN     10.0**    -IE       IS    CONSIDERED    ZERO .  ,//,8 X  ,  4 7H    THE 
6    DEFAULT    VALUE    OF    THIS    PARAMETER      IE       IS    6. ,/, 8X, 28HIS    OTHER    WORDS 

7,  IE    =    1  .CE-6.  ,//  ,1QX,66HIF    YCU    DESIEE    A    DIFFERENT    MARKOV    CSITEEIA 

8,  TYPE  TEE  INTEGER  V  ALU E.  ,// ,  1C2 , U8H IF  YCU  DESIRE  THE  DEFAULT  VALU 
9E,    TYPE    "0"       ZERO    ) 

670  FORMAT     (//,5X,61HDC    YOU    DESIRE    TO    SYNTHESIZE    A    STABLE    FILTER       OR    R 

1EGULATOR  3 Y , /  ,8 X  ,34 HDEST AB I LIZING  THE  ORIGINAL  SYSTEM?,// , 1 2X, 52H 
2  NOTE: WCEKS  FOR  FILTER  OR  REGULATOR  EUT  NOT  FOR  BOT H,/ ,20 X , 1 7 HIN  T 
3HE    SAME    RON.     , // ,  10 X  ,  19 HT YP E     "YES"    OR    "NO".) 

580  FORMAT     (5X,53HEO    YCU    DESIRE    TC    FEINT    THE    EULER-LAGR ANG E    EIGENSYSTE 

1M,/,3X  ,50H?RICE  TC  CECO  MPOS  IT  ICN  FOR  CHECKING  THE  PROGRAM  ?,//,10 
2X.19HTXPE    "YES"    OR    "NO".) 

690  FORMAT     (//, 5 X  ,  39 H FOW ER    SPECTRAL    DENSITY       PSD       OPTION    1     :,//,10X,53 

1HCPTION  1  —  CCMPDTI  THE  PSD  OF  THE  OUTPUTS  AND/OR  I  HE ,/ , 2 2 X , 43 HCO 
2NTBCLS  OF  THE  CONTROLLED  SYSTEf  WHEN  FORCED  BY ,/ , 22 X  ,4 SHPR0CE5S  AN 
3D    MEASUREMENT    NOISE.  NOTE:     ECTH    A, /  ,  2 2 X , 4b HR EGUL ATOR    AND    A    FTLT2 

4R  MUST  BE  RESIDENT  IN  TH E  ,/ ,  2 2X.23HP EOG 5  AM  TO  USE  THIS  OPTION.  , // 
5.10X.53HCETIOH  2  —  SAME  AS  CETICN  1  ABOVE  3UT  ONLY  PRINT  THE,/, 22 
6X,3UHRESID0ES  OF  EACH  TRANSFER  FU  NCT  10  N  ,/ ,  22  X  ,  28  HUS  ED  IN  THE  PSD  C 
7OMPUTATION.,//,10X,24HOPTION  3  —  NOT  DESIRED. ,///,  1 0X ,29 HSELECT  A 
8N    OPTION:    1,     2,    OB    3.) 

700  FORMAT     (//,5 X  ,39HEOH EH    SPECTRAL    DENSITY       PSD       OPTION    2    :,//,10X,35 

1BCPTION  1  —  FED  OUTPUT  NCT  D ESIRED.  ,//, 1 0X , 33 HOPTION  2  —  COMPUTE 
2  ONLY  OUTPUT  F SC° S.  ,//, 1  OX, 3 9  EC PTION  3  —  COMPUTE  ONLY  CONTROL  PSD 
3°S.,//,1CX,50HCE1ICN  4  —  COMEUTE  BOTH  OUTPUT  AND  CONTROL  PSD°S.,/ 
<*/.  15X, 32BSELECT    AN    OPTION:     1,    2,    3,     OR    4.) 

710  FORMAT     (//,5X,39HCC    YCU    DESIRE    REGULATOF    SYNTHESIS    ONL Y? , // ,  10X ,  19 

1HTYPE    "YES"    OR    "NO".,//) 

720  FORMAT     ( /.5X.47EENTER   THE    #    OF    STATES       NS       OF    THE    SYSTEM    MATRIX,/, 

15X,13H     ^F^-MATRIX    .) 

730  FORMAT     (/ ,5X , 5 6  BE NTER    THE    #    CF    CONTROLS       NC      OF    THE    CONTROL    SYSTEM 

1     MODEL    /    5X     i3H    "Gn— ffATRIX    .) 

740  FORMAT' (/,5X,5UKENTEB    THE    #*OF    MEASUREMENTS    OR    OBSERVATIONS       NO       0 

1FTHE,/,5X,13H    "H"-KATRIX     .) 

750  FOHMAT     (/ ,5X, a 8HENTE R    THE    #    OF    FBOCESS    NOISE    SOURCES       NG       OF    THE,/ 

1.5X,17H    "GAMMA"-MATRIX    .) 

760  FORMAT     ( 5X, 52 H F L AG/ F ABA  METE R    SETTINGS    FOR    THIS    RUN    ABE    AS     FOLLOWS: 

1  ,/) 

77  0  FORMAT     (1X,3HIOL,2X,2HIQ,2X,2HIR,2X, 3HISS , 2X, 2 HIM , 2X ,4 HITF 1 . 2 X, 4  HI 

1TF2,2X,4HITF3,2X,5HIFDFW, 2X,2EIE,2X, 6 HI DEBUG ,2 X,  4 HISET ,2X , 6 HIDST AB 
2,/) 

780    FORMAT  (1X,I2,3X,I2,3X,I2,2X,I2,3X,I2,3I,I2,4X,I2,4X,I2,UX,I2,4X,I 
12.3X,I2,6X,I2,5X,I2  ./) 

790    FORMAT  ( 1 X, 4 H IPS D  ,  2X ,3HIY U, 2X  ,  5HINOR M , 21, 4 HI REG , 2X , 2HN S,2X , 2HNC , 2X 
1 .3HN03 ,2X,2HNG  ,/) 

800  FORMAT     (2X,I2,3X,I2,4X,I2,SX,I2,3X,I2,2X,I2,3X,I2,2X,I2,//) 

810  FORMAT       2X,17HCRDES    CF    SYSTEM    = , 13 ,// , 2 X , 20H NU M 8 ER    OF    CONTROLS    =  ,1 

1 3  ,//,2 X, 24HNUMEER    OF    OBSERVATIONS    = , 13, // , 2X , 3 3HNUMB ER    OF    PROCESS 
2NCISE    30UEC2S    *,I2,////) 

820  FORMAT     { 5 X ,5 3 H DET E R MINE    THE    NORMALIZATION    PARAMETER       INORM        FOR    TH 

1E,/,5X,55HPCWEB  SFECTRAL  DENSITY  PSD  CFTION  YOU  HAVE  PREVIOUSLY, 
2/,3X,52HCHOSEN.  T'.C  PSD  NORMALIZATION  METHODS  ARE  A  V  AILA3L  S:  , // ,  13 
3X.54HMETHCD  1  —  FSE  IS  NORMALIZED  BY  THE  I-NORM°TH  PROCESS ./, 2 1 X , 
429HNOTSE    Mi:iUS    "Q"    INORM,  INORM    . ,/,2  1X,49H    NOTE:     "Q"    IS    AN    OPTIMAL 

5    STATE     WEIGHTING    MATRIX.      ,/  ,2  1X  ,34HI N    THIS    METHOD,     INORM    =0,1, , 

6NG.,// ,1 CX,63HMETHOD    2    --    PSD    IS    NORMALIZED    BY    THE       INORM    -NG    °TH 
7MEASUREMENT,/,21  X,39HNOISE    MINUS    "R"    INCRM    -    NG, INORM    -    NG    .  ,/,21X. 
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3,51H  NOTE:  "R"  IS  AN  OPTIMAL  CONTROL  WEIGHTING  MATRIX.  ,/,21X,44HI 
9M  THIS  METHOD,  INCRS  =  NG  ♦•  1....-HG  *  NO E. , //, 1  OX , 5 1 KSEL ZCT  AN  IN 
STEGER  FRCK  0-16  REPRESENTING  YOUR  PSD  ./ ,  15 X, 27 HNO RMALIZ AT  10 N  R EQ 
SOIEEHEHlS-#//,10Xf53HIF  PSD  NORMALIZATION  IS  NOT  DESIRED  ENTER  "C" 
$       ZERO    .  ) 

830  FORMAT     (5X-43HAMALXSIS    COMPLETE.     DO     YOU    WANT    ANOTHER    R UN? , / ,  1  5X  ,  19 

1HTYPS     "YES*    OR    "NC".) 

840  FORMAT     (///, 5 X  ,4 8EDC    YOU     WISH    TC    SAVE    THE    "'"-MATRIX    PFOM    THE    LAST 

1  /  5X  JoiiBUS  TC  EE  USED  IN  THE  FOLLOWING  RUN?  //  5X  3 a  'V.O  T  E :  THE  '* 
2ATRIx'wiLI.  3E*REDISPLAYED  AT',/,5x"34HTHE  PROPER  £np6t  SEQUENCE  INT 
3ESVAL, /,5X,4QHANC  YOU  WILL  HAVE  THE  OPTION  OF  CHANGING ,/,5X .27HIKD 
4IVIDUAL    MATRIX    EIEME &TS. ,// , 1 5 X , 1 9HT Y PE     "YES"    OR    "NO".) 

850  FORMAT      (///, 5 X  ,  46 E DC    YOU     WISH    1C    SAVE    THE    "H"-MATRIX    FROM    THE    LAST 


4IVIDUAL    MATRIX    EIEME &TS. ,// , 1 5 X , 1 9HT Y PE     "YES"    OR     "NO".) 

FORMAT     J///,5X,4eECC    YOU     WISH    IC    SAVE    THE    "H"-MATRIX    FROM 
1  ,/,5X, 36HEUN     TC    EE    USED     IN    THE    FOLLOWING    R UN? , //, 5 X , 39 HNOT E:     THE 


2ATRIX  WILL  BE  REDISPLAYED  AT , / , 5X , 34 HTH E  PROPE3  INPUT  SEQUENCE  INT 
3ERVAL,/, 5X,40EANC  YOU  WILL  HAVE  THE  CFTION  OF  CH ANG ING ,/, 5 X , 27H I ND 
4IVI00AL    MATRIX    E  LEM  E  MS.  ,//  ,  1  5X.  1  9HT  YPE     "YES"    OR    "NO".) 

860  FORMAT     (///, 5 X ,48EDO    YOU     WISH    TO    SAVE    THE    "G"-MATRIX    FROM    THE    LAST 

1  ,/.5X,  36HR0N  TC  EE  USED  IN  THE  FOLLOWING  RUN? , // , 5 X  .39 HNOT E :  THE  M 
2ATRIX  WILL  3S  REDISPLAYED  AT . / ,5X , 34 HT H E  PROPER  INPUT  SEQUENCE  INT 
3EEVAL,/,5X,40HAND  YCU  5TIIL  HAVE  THE  OPTION  OF  CHANGING  ,/,5X,  27HIKD 
4IVIDUAL    MATRIX    EIE ME STS.  ,// , 1 5X, 1 9KT YPE     "YES"    OR    "NO".) 

870  FORMAT     (///,  5 X , 5 2EEO    YOU     WISH    TO    SAVE    THE    "GAMMA" -M ATSIX    FROM    THE 

1LAST,/.5X,36HEUN  TO  EE  USED  IN  THE  FOLLOWING  RUN ? ,// .5 X , 39 HNOTE :  T 
2HE  MATRIX  SILL  EE  REDISPLAYED  AT ,/, 5 X , 3 4HTHE  PROPER  INPUT  SEQUENCE 
3  INTERVAL, /,5X,4CEANC  YOU  WILL  HAVE  THE  CPTION  OF  CHANGING ,/,5X, 27 
4HINDIVID0AL    MATRIX    EIEME NTS .  , // ,  1  5X,  1  9 HTY P E    "YES"    OR    "NO".) 

880  FCEMAT      ( IX , 5 1 H W A R NING:     IMPROPER    DATA     ENTRY!       ENTER     "YES"    OR    "NO".) 

890  FORMAT     ( 5 X ,5 9 HOPT S YS I   IS     A    COPELETELY    INTERACTIVE    OPTIMAL    SYSTEMS 

1CONTROL,/,8X.55EPFOGFAa.  IT  WILL  SOLVE  NUMEROUS  CONTROL  PROBLEMS  0 
2N  THE, /,3X,4dHECLLCWISG  TYPES  CF  SYSTEMS  CONTROL  EQO ATIONS : ,//, 1 5X 
3.35HXDCT  =  F  *X  +  G  *U  >  GAM  *  (W  ♦■  WO)  ,// ,  20X  ,  22  HM  EAS  UREM  EN  T  EQUA 
4TI0N — ,//,15X,21H2  =  H  *X  +  D  *W  +  V , // , 20 X, 29 HRSGUL ATO R  PERFORM 
5AIICE  INDEX--,// ,15X,42HJ  =  1/2  *  INTEGRAL  (Y  *  A  «Y  ♦  U  *  B  *D)DT, 
6//.20X.32HSTATE  EEECEACK  GAIN  DEFINITION — ,//,25X,10HU  =  -  C  *X,// 
7,15X,45HEC    YOU    SIEH    TO    CONTINUE?       TYPE    "YES"    OR    "NO".) 

900  FORMAT     (25X,  14B--EATA    ENTRY  —  ,//, 5X , 49H ALTHOUGH    OPTSYSX    IS    3PECIEI 

1CALLY  DESIGNED  TC  RE  AD, / . 5X , 4 8  HALL  MATRIX  DATA  INTERACTIVELY,  SEVE 
2SAL  ALTERNATE, /,5X, 3  1HMETHODS  ARE  AVAILABLE  TO  USERS  :  , // ,  1  0  X  ,  4  3  H  ME 
3THGD  1 — THE  "F","G"  AND  "GAMK/"  MAT  RICES , /, 1 3 X, 37 HM AY  3S  READ  PRO 
4M  SEPARATE  DATA  FILES.  , // , 1 0 X , 5 OHMET HOD  2 — THE  r,F","G",  AND  "GAMMA 
5"  .1ATRICSS  MAY  EE  ,/ .  13X  ,  4  5HEXI IICITL  Y  DEFINED  WITHIN  SUBROUTINE  "S 
6ETUP". ,//,10X,52H  NOTE:  IN  EITEEH  CASE,  THE  USSR  SHOULD  OBTAIN  A  C 
70PY,/, 17X.34HCF  TEE  PROGRAM  LISTING  AND  EX AMIN E, / ,1 7 X, 39HT HE  EXAMP 
8LES  CONTAINED  IN  S/R  "SETUP".  ,// ,  1 0  X ,  4  5HDO  YOU  WISH  TO  CONTINUE? 
9    TYPE     "YES"    OB     "NC".) 

910  FCEMAT     (//,5X,46ECO    YOU     WISH    TC    INPUT    THE    "?",     "G",     AND    "GAMMA",/, 

1 1CX,40HMATRICES  FF-CM  SU3RCDTIME  "SETUP"  IAW  TH E, / , 1 0 X, 40 HM ETHCD  DS 
2SCSI3ED    ON    THE    PREVIOUS     SCR EE N ? ,//,  1 5X ,  19HTY PE    "YES"    OR    "NO".) 

920  FORMAT     (//,41H OPTSYSX    IS    NOW    TEFMINATED ,//) 

END 
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_SUEHO0TINE_SEiaE     (  £  A  ,  G,  GAM,  MS  ,MC,NG) 

IMPLICIT    BIAL*e7A-B,0-Z) 

DIM2NSI0H    3 A  (NS  ,NS)  ,  G(NS  ,NC)  , GAM(NS,  NG)  .  D'J  M  (  82  ,  35) 

COMMON    /EHOG/    IOL  ,  10  ,  13  ,  ISS  ,  I  B  ,ITF1  ,  ITF2,ITF3,IF  DFW  ,IE,IDSTAB,ID£B 
10G,ISST,IREG,  IESD,IY'J,INORM 

C 

C       EILE    DEFINITIONS 

C 

CALL    F8TCMS     ('FILSDEF    •      '  03  '.'DISK  ','X29A82       ', 

1  "DATA  *,»A  ?) 

C 

C       TKIS    IS    AN    EKAMPLE    CF    MS   82     X    95     CATA    ?TLE    X29A82    DATA    A1     ?.EAD    FROM 

C       A    USER'S    DISK    AND    CONVERTED     (FROM    A    "DUMMY"    ARRAY    MAttED    •OOH')     TC    A 

C       SYMMETRIC    ARRAY.        THE    FORMAT    STATEMENT     MUST    MATCH    YOUR    DISK    DATA 

C       FC3MAT    OS    THE    PRCGFAM    SILL     FAIL!        NOTE:     ALL    PROGRAM    DIHENSIOMS 

C       MUST    EE    BNLAEGEC     ACCORDINGLY    FOR    A    SYSTEM    OF    THIS    SIZE. 

c 

BEAD  (3,50)   {  (COM  (I, J)  ,J  =  1,35)  ,1  =  1, NS) 
DO  20  1  =  1  ,NS 
CO  10  J=1,NS 
BA  |I,J)  =DUH  (I  ,J) 
10     CONTINUE 

20     CONTINUE 

c 

C       TEESE    ARE    EXAMPLES    CF    SrVERAL    POSSIBLE     METHODS    OF    ARRAY    GENERATION 

C       WITHIN    SUERCUTINE    SETUP. THE     "GAM"    AR^AY     SAS    SET    TO    ZERO    SINCE     NO 

C       "NOISE"    WAS    PRESENT,    ANC   THE    NCN-ZER<J    ELEMENTS    OF    THE    "G"    ARRAY    WERE 

C       EXPLICITLY     DEFINED.     THEY    COULD     ALSO    3E     READ    FROM    FILES    AS    ABOVE. 

c 

DC    40     1=1, NS 

DO    30    J=1.NC 

GAS  (I,  J)  =0.  OD  +  OO 

G  (I.J)  =0.CD+0  0 

G  (82,  1)=C.  1Q00E+O1 
30  CONTINUE 

40  CONTINUE 

BE TURN 
c 

50  FORMAT     (5(212.4)) 

END 
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c= 


3UEE0UTINE    CHECK     (  EPS  ,  NC  ,  NG  ,N  C  ,  IB  ET) 


C  _CHECKS    THE_CGNSISiElJCY    OF    SEQCISTED    CPTIONS.__  = 

DOUBLE    PRECISION    EES 

COMMON    /PSOG/     IOL , IQ , IB , ISS , I H ,ITF1 ,  ITF 2 , ITF3 , IFDFW , 12 ,IDST A3 ,1D EB 
1UG,ISET,IESG  .IESD.ISO.IHOBH 
C SET    /.DEAL    ANALYSIS    9HEN    OL    EIGENSY S    OS    OL    TF    REQUESTED 

IF     (Ii1     .EC-     1     .ANE.     IOL    .  EQ.     0)     IOL=1 

IF     (IOL    .EQ-     3    .00.     ITF1     .NE.     C)     13=1 
c CHECK    TO    SEE     IF     H     WATHIX     INPUT 

IF     (NO    .  NE.    0     .OS.    ICL    .GE.     2)     GO    TO     10 

WRITE     (5,90) 

IEET=1 

RETURN 
10             CONTINUE 
c TRANSFER   FUNCTION    CHECKS 

IF     (IE    . EC-    0)     I£=6 

SPS  =  10  .**  (-IE) 
C 

WEITJT  (5,  100) 


OPEN    LOOP    TF 

ITF1     .EQ.     0    .CB.     NC     .  NE    .     0)     GO    TO    20 


I3ET=1 
BETURN 
C CCMPENSATOB    TF 

20  IF     (ITF3     .EQ.     0)     GO    TO    JO 

IF     (IREG    .EQ.     C    .AND.     (NC    .HE.    0    .AND.     NG    .NE.     J))     GO    TO     30 

WEIT2     (5,110) 

IBET=1 

BEIU2J! 
30             CONTINUE 
c NOISE    TF 

IF     (ITF2    -EQ.     0)     GO     10    40 

IF     (NG.NE.    0     .AND.     NC    .NE.    0)     GO    TO    40 

WHITE     (5,120) 

I R  E  T  =  1 

BETUBN 

c DESTABILI2ATI0N     RESTRICTIONS 

UO  IF     (IDSTAE    .EQ.    0)     GC   TO     50 

IF      NC     .EQ.     0)     GC    TO    50 

IF     (NG    .NE.     0)     IF.EG=1 

WRITE     (5,130) 

IF     (IREG    .EQ.      1)     GO    TO    50 

IEET=1 

BETUBN 
50           CONTINUE 
C PSC    INPUT 

IF     (I?SD     .EQ.     C)     GO    TO    30 

IF     (I?SD    .LT.     0    -OB.    IPSD    .GT.    3)     GO    TO    60 

IF     (IYU     .IT.     0    .OB.     IYU     .  GT  .     3)     GO   TC    60 

IF 

GO 
60  WHITE     (5,140) 

IBET=1 

EETURN 
70  IF     (13  EG     -EQ.     0    .AND.    NC     .NE.     0)     GO    TO    80 

WHITE     (5,150) 

IRET=1 

BETUBN 
80  CONTINUE 

BETUBN 

C 

90  FCBMAT     (//,5X,49E    B    -   MATRIX    MUST    3E     INPUT,    I.E.     "NO"    MUST     BE    >    0. 

100  FOatlAT     (//,5X,46H(G)     MATRIX    MUST    3E     INPUT,    I.E.     NC    BUST    BE    >    0.,/, 

110X.26HTC    C03PUTE    OPEN    LOCP    T.    F.,//f  n       n    „„„„,„, 

110  FCBIIAT     (//,5X  .48BBEGULATOB    AND    FILTER    SYNTHESIS    MUST    3E    REQUESTED, 

1/,5X,uuHlN    THE    SAHE    3UN    TO    COKEOTE    COMPENSATOR    T.     F.  ,/ , 5X  ,  47  HI. E . 

2IBEG    MUST    =    0.:     "NC"    AND    "NG"    MUST    3E    >    0.,//) 
120  FORMAT     (//,5X,51HNOISE    T.    F.     CALCULATED    ONLY    WHEN    REGULATOR     DESIGN 

1EE,/,5X,47HI.  E.     IBEG    MUST    =     1.;    "NC"     AND    "NG"    "1UST    BE    >    0.,//) 
130  FORMAT     (//,5X,47HEESTABILIZATICN    OPTION    DESIGNED    FOR    A    REGULATCB,/ 

1.5X.38HOR    FILTER    5UT    NOT     20TH    SIMULT ANEOUS LY . , //, 5X  ,55  HIF    "NG"    >    0 

2.     THE    REGULATCB    CPTICN    IS    AUTOMATICALLY    SET!,//) 
140  FORMAT     (//,5X,49H     **********     INCONSISTENT     ?3  D    INPUT     FLAGS     ******** 

1,//) 


(IYU     .IT.     0    .OB.     IYU     .GT.     3)     GO   TC    60 

(INCRM    .LT.     0    .OB.    INORM     .GT.     NG*NO)     GO    TO    60 

TO    7  0 


80 


150  fCBMAT     (//,5X,4UfiEOTH    A     REGULATOR    AND    FILTER    SUST    3E    8  ESID  EilT  ,/ ,  10 

1X,42HTO    CCKPOTE    TFE    ESD    05    A    CONTROLLED    SYSTES! ,/,1 QZ.42HI. S.     IREG 
2    MOST    3E    0.     AXE    "NC"    MUST    3E     >    0-,//) 
ENE 


SOBHOUTINE    INNEB     (NS , NC , NO, NG  ,N2 , ACL , 3, 3A , CI rC3 , CO, CWI ,CW 3 , D, F3GC, 
IFBGE.G  ,G AM,  Gil ,  GN  ,HQ ,D1 ,D2  ,PEO  ,SM, 2C,  £,SC, WR, MI, rf 1 1 , W~ ' 


2SflI,DESTAE,AA, EH, CS , JCP , BES , AY, 
3AH,ISAG,IGAH,IBEI,gBT?,MgCa , NCCL) 

IMPLICIT    3EAL*8  (A-H,C-Z) 


21rX,WNOHH,W NO 

C  ,CP,GW,GV,HY  ,HU,DST0R2,ISAF,I3 


DIMENSION    ACL 
II  (NS)  ,  CVS  (NS) 
2)  ,  RC  (NO,NC)  ,SC 
3,GN  (NS  ,NS)  .HO 


(NS.KS1  tB(NC,NC)  ,£A  (NS  ,  „J;  ,„*  i^ 

,  JEGC  (NC,NS)  ,FBG2  (NS.NO)  ,G  (NS,NS 


NS) , CI (NS 


(NS,NS)  ,HB(N2)  ,  »I  (I 

*C  ,NS)  ,D1  (N2),D2  fNI 


,CB  (NS)  ,CQ  (NS.NS)  ,CW 

,aa(NS,Ss)  ,pbo<ns,  ns 

,NS)  ,  W21  (NS,NS)  ,  1  (N2,N2) 

2)  ,  J  ClG,:iG)  ,  0(NO,:iC)  ,GAM 


(N2)  ,  W"11  (NS 
NS)  ,HO  (SC  ,NS)  ,01  (N2),D2  (H21  ,  R  fl  ( N  2  ,  N 
4 (N3,NG)  ,  9KOB.1  (NS,NS)  ,WNOBMI  f  NS  ,NS)  ,D  ESTAB  (NS  j  ,  A  A  (NS  ,'NS)  ,BH  (NS.NC)  « 
5CM  (NO,  NS)  ,JCF  (N2)  ,RES(N2)  ,AnSC,Nt)  ,  3E(N2)  ,CC(N2)  ,  C?  (N  S)  ,  S  H  (U2 ,  MG) 
6  ,GV  (N2 ,NC)  ,HY  (NO,N2)  ,dO  (NC,N2)  ,DST0B2  (NS,NS)  ,  PRTT  (16,1b) 

COMMON    /FROG/    ICL  ,1 Q  ,12 , ISS , I K ,11 F1  ,  IT F2 , ITF3 , I? DFW , IE ,IDST AE , IDZ3 
10G,ISST, IEEG, IPSE,  IYU, ISO  BH 


B£AL*u    FMT(20) 

0 
PEN    L 
S     VAL 
L    FIL 
AL    C 
AL    f. 
AL    C 
Y    STA 
STATE 


•ICL=1    IF 
10  =  1    I? 

•IB=0    IF 

•IH=1  IF 
IH=2  IF 
IR  =  3    IF 

•ISS=1    I? 

■13=1    IF 


TEE  o; 
THE  ?.B! 
OPTIMA] 
EXTEBNl 
EXTEHN. 
EXTERN] 

STEAD^ 
MODAL 


CTPUT    OPTIONS 

CCP    EIGENSYSTEH    IS    D2SI3ED--OTH2RW IS2    IOL=0 

UES    OF     THE     CCNTFOL-    AND    STATE    A3  E    TO     BE    FOOND 

TEP    AND    32GULATOH    EIGZNSYSTSHS    ASS    TO    BE     FOUND 

KATHIX    IS    3UEELIED 

IS    SUPPLIED 

AND    5    ABE    SUPPLIED 

TE    VALUES    ARE    TO    32    DETERMINED 

£    DESIRED 


10 

20 
30 


uo 


50 
C-- 


60 


c 


10 


NS£=NS*NS 

MH  =  NS 

a  =  N2 

CALL    CHECK    (EPS,  MC,  3JG,NO  ,  IBET) 

IF     (I3SI.EQ.1)     BEIU2S 

IF     (IS  IT.  EQ.  ij     GO    10    20 

CALL    REACF     (NS,ISA7,EA) 

IF     (IDSTAE.  EQ.  0)     GO    TO 

MRITE"  (5  ,  1800) 

CALL    RDREAL     (ANSR) 

DSTAB=ANSE 

DC    10    1=1, NS 

DESTAB  (I) =DSTAB 

CONTINUE 

GO    TO    3  0 

CALL    SETUP     (BA,G,C-AM,NS 

CONTINUE 

WHITE     (6,1380) 

DO    uO    1=1, NS 

BBIT2     (6,1390) 

IF     (IDSTAE.  EQ. 

WRITE     (6,1480) 

SRITF.     (6,1390) 

CONTINUE 

2IGENSYSTEM   OF 

IF     (IOL.  EC.O.  ANE.  IQ.  EG.  0) 

IF     (IOL. EC.. 0.  AND.NC.b£.  J) 

DO    60     1=1, NS 

DO    60    J=1,NS 

GN  (I,  J)  =  EA  (I,  J) 

CALL    3ALANC     (N  S  ,  SS  ,G  N  -LOW  ,1  HIGH,  D1) 

CALL    ORTEES     (  NS  ,  NS  ,LC3,  I  HIGH  ,  GN,  D2j 


(EA(I,J) 

0)     GO    TO 


NG, NC) 


,  J  =  1  ,NS) 
50 


(DESTAB(I)  ,1=1  ,SS) 


THE 
GO 

GO 


CEEN    LOCP 
TO    90 
TC    90 


DYNAMICS- 


OBTPAN     (HS,NS,ICS,IHIGH,GS,D2,SC) 

~'j,  GN  ,  CUR,  CWI, 


SC,IERR) 


IBB) 

EIGENSYST2M- 


CALL    OBTPAN     (  N  S  ,  NS  ,  LOW,  I  3IG 

CALL    HC.E2     (NS  ,  NS  ,  LOW  ,IHIG  H, 

IF     (I2RR.NE.0)     CALL    EREXIT     (NS.GN.ILn. 

CALL    BALBAK     ( N S , NS  ,  LOW, I HIG H , C  1, NS, S C) 

NORMALIZE    AND    PRINT    OPES    LOOP     E] 

IHHITE=1 

CALL    CNOEM    (CWH.CWI, SC, HS ,1 WHITE, 3SQ  ,DDD , D 1 , D2 , J NORM ,W NORM I , HC , CM, 
1NC,NS) 
IF     (IOL.  EC- 2)      RETURN 

"  .O.OR.  (NC.NE.O.OH-IDSTAB.GT  .0)  )  GO  TO  90 


IF  (IQ  .SC.J.C 
DC  70  1=1, NS 
IF  (CWR  (I)  .LT.O. 
WRIT2  (5,1U90) 
RETURN 


)  GO  TO  7  0 
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70  CONTINUE 

IF     (IOL.  EQ.3)      GO    TO     130 

DO    80    1=1, :is 

DC    80    J=1,NS 
80  H1 1  (I.J)  =  SC  (I  ,J) 

CALL    r1 1  il  V     (NSQ  ,i  1  1,NS,DDD,D1  rE2) 
90  CONTINUE 

If     (IDS!  AE.SQ.  C)     GO    TO    130 
r ?CSfl    U    *    DIAG  (DESTAB)      *    O-INV 

DC    100    J=1,NS 

DO    100    1=1. MS 
100  AA  (I.J)=HHORH  (I, J)* DESTAB  (J) 

DO  120  1*1, 3S 

DC  120  J  =  1,NS 

DDD=0. DO 

DC  110  K=1,HS 
110    DDE  =  DDD«- AA  (I  ,  X)  *WSOEKI  (K,  J) 

DSTORZ  (I, J)  =  DDE 
120    BA  (I,J) =BA(I, J) +DDD 
130    CONTINUE 

CALL  3EAEH  ( NC , US  ,  IS  AH, HO) 

WRIT!-     (6,1440) 

DC    1U0     1=1,  MO 
1U0         WRITS     (6.1390)      (HC  (I.J)  ,  J  =  1  ,NS) 

IF     (IH.Hi.1)     5C    IC     15V 

CALL    JCDE     (aSCBH,HO,Cfl,HSfHCf KS.2) 
150  CONTINUE 

IF     (IFDFW.SQ.C)     GC    TC    170 

CALL    3EAEE    (HC,HC,D) 

WRITS     (6,1470) 

DC    160     I  =  1 ,  :i 0 
160         'WRITE     (6,1390)      (D  (I ,  J)  ,  J=  1 ,  :iC) 
17  0  CONTINUE 

HOS=0 

IF     (NC.  EC. 3)     GO    TC    590 

IF     (IOL. ZQ. 3)     GO    TC    270 

IF     (ia.aE-1.A»C.IS.NE.3)     GO    TC    210 

IF     (ISST.EQ.  1  )     GO    TO    130 

CAIL    BEALG    (HS,NC,IS  AG,  G) 
180  CONTINUE 

CALL    3EAEFB     fNC,HS,£EGC) 

WRITS     (6,1400) 

DC    190     1=1, NS 
190  WRITE     (6.1390)      (G  ll  ,  J)  ,  J=  1  ,  NC) 

IF     (ia.NE.1)      GC    TC    200 

CALL    MODE     (WNCSflI,G,EM,MS,aS,KC,0) 
200  CONTINUE 

GO    TO    33  0 
210  DO    220     1=1, NS 

DO    220    J=1,NS 
220  RH(H-MH,  J)=0.  0 

CALL    3EADAY     (NO, AY) 

DO    240    1=1, NO 

DO    240    0=1, NS 

DDC=0.  DO 

DO    230    K=1,NO 
230  EEE=DDD+ AY (I, K) *  EC  (K,J) 

240  AA(I,J)=DDD 

WRITS     (6,1460) 

DO    250    1  =  1,  NO 
250         WRITE     (6,1390)      (A  Y  (I  ,  J)  ,  J=1  ,  NC) 

DC    26  0     I=1,NS 

DO    260    J=1,NS 

DO    260     K=1,NO 
260  RR  (I+HH,  J)=RM  (I+HB, J)+AA  (K,I)  *HO  (K,J) 

270         IE     (ISET.EQ.  1)     GO    TO    280 

CALL    3EADG     (N  S  ,  NC  ,IS  AG,  G) 
280  CONTINUE 

IF     (IOL. EQ.3)     GO    TO    290 

CALL    3EAEE     (NC,E) 
290         WRITE     (6,1400) 

DC    300     1=1, NS 
300  WRITE     (6,1390)      (G  (I.J)  ,J=1,NC) 

IF     (IM.NE.1)      GC    TC    3  10 

CALL    J1CDE     (WNORHI  ,G,Bfl,NS,NS  ,  NC,0) 
310  CONTINUE 
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320 
330 
C— ■ 
340 


350 


360 

C~ 

C 

C 

c 
c 
c 
c 
c 
c 
c 
c 
c~ 


I?     (10 
WRITS 
DO    320 

WHITS 
IF     (IT 


WRITE 

ITFX=1 

CALL    I 

1  BR,C1II 

I?  (10 
IF  JNG 
GC  TO 
COSTIV 
IF  (I?. 
•CALCULAI 


T" 


(o 


FEN    LOCP    T  HANS  FES    FUNCTIONS- 


t: 

.  E 
60! 
OE 

ro 


EC  3)      GO    TO    340 

,1410) 

=  1.NC 

,1390) 

.EQ.Of 

0 

,  1500) 

(NS,NS  ,N."C.  ,E  A,AA,  MC  ,  G,EH,30.  HO , C* , IF D? W, D , 38 ,CC, C?  ,  WH  ,A 
C,JCF,HES,01  -D2 , ODD , E E5 , ITF1  .IT EX) 
NE.3)      GO    TO     360 

'    0)      HETU5N 

C-1.0B.IH.E0.3)     GO    TO    500 

N    OF    CCNTECL    GAI NS: FO 5EATION    CF    CONTROL    HAMILTONIAN 


•G3»EI*G3T 


■FT 


**«F    AND    FT    ARE    THE    OPEN    LOOP 

DYMA3ICS    MATRIX    AND    TRANSPOSE 

***EI    IS    HCXNC    CONTROL    WEIGHTING 
.1ATRIX 

*** A    IS    THE    N5XNS    STATE    WEIGHTING 
HA1BIX 

***GH    IS    THE    NSXHC    CONTROL 

DISTRIBUTION  MATRIX 


370 

380 

C  — 


c 

390 

C— 

400 


410 


420 
430 

440 
C— • 


DO    370    1=1, NC 
DO    370    J=1,3H 


PRO  (I.J)  =G  (J,I)/B  II, I) 

EC   39 J    1=1, aa 

DC    330    J=1,3H 

Rfl  (I.J  ♦  HH)=0.  CO 

DO    380     K=1,NC 

BH  (I.  J  *«E)  =33  (I,  J +3  5)  -G  (I,X)  *EHO(K,J) 

2NX2N    RAMILTONIA5    3AI31X- 


•DIAGONAL 
DO    390    1=1, HH 

CO   390    j*i,sh 

aa  (i, Ji  =ba  (i ,  j) 

aa  (i+HH,j*dH)  =-ea  (j,  i) 


ELOCXS H  1 1     AND     A22- 


INT  (3, a  ,K,9  .RH.4  ,•  (9  (1X, 
INC  {a, a,  EH,  LOW,  IHIGH,C1) 
!ES     (3,ff,LCW,IHIGH,R3  ,£2) 


,NE.     0)     CALL   SREXIT      (HfaH,IESB) 

;a,a,LOW,iHiGH,  di  ,a,x) 


CN    EULEB-LAGRANGE    EO.UATIONS- 
430 


■M21     BLOCK 

BK  <H-».H,  J)=-aa  (I*BH,  J) 
«12     3LCCK    IS    DEFINED    IN    LINE    430    AEOVS- 

CCNTINUE 

IF     (IDEBOG.EO.  0)     GO    TO    410 

WBIT2     (6,1510) 

CALL    3APRNT     (  3  ,3  ,fi  ,9  .  R3  ,  4     «  (  9  ( 1  X,  1PD  1  3.  6)  )  • ) 

CALL    BALA!" 

CALL    OSTHI 

CALL    Q3TRAN     (  9  ,3  ,  10  W  ,IH  I  G  H,  aa  ,  C2  ,  X) 

CALL    HC22     (  H  ,  3  .LOW  ,  I  HIGH  ,  BH  ,  W  E  ,  WI  ,X  ,  IER  B) 

IF  (IERR 

CALL  3ALBAK  (! 
DEBUG  DIAGNOSTICS 

IF  (IDEEUG  .EC.  0)  GC  TO 

WRITE  (6,1520) 

DC  420  1=1,3 

WRITE  (6  ,1530)  *B  (I)  ,WI  (I) 

WBITE  (6  ;  1540) 

CALL  3APHNT  (3  ,B  ,  a  ,  9  ,1, 4 ,  •  (9  (  U , 1 PD 1 3 . 6 ) )  ' ) 

CONTINUE 

IF     (IOSTAB    .EC     1)     GC   TO    44  0 

IF    (HOB.EC.O)     WRITE     (6,1550) 

IF     (NOB.NE.O)      WRIIE     (6.1560) 

IF     (N03.  NE.     0)     GO    TO    750 

CALL    3  GAIN     (3  ,  NS  ,  NC  ,  NOB , W 8, WI,X,GN,W  11, Bfl,W21, 01  ,  C'J  R  ,  CWI,  S  C  ,  3  HS  , D2 
1) 
CHECK    EIGENVECTORS 

IF     (IDEEUG    .EQ.    0)     GC   TO     450 

WRITE     (6,1570) 

APRNT     (NS,NS,NS,9,SC,4, '  (9  (IX,  1PD13.6)  )  ') 


CALL    3A 
450         CONTINUE 
C BESET     FLAG    ANC 

IF     (IDSTAE    .2Q. 

DC    460     1=1, N5 


F    3ATRIX 
0)     GC    TO 


FOR 
47  0 


ITERATIVE    DESTABILIZATION    CASE- 
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4  60 

U70 
C— • 
C  — 

c— 


480 
490 


SA(I,I)=EAiI,I)  -DESTAB(I) 

IH=1 

CONTINUE 

CALCULATION    OF    FEEDBACK    GAIN 

FEEDBACK    GAINS >       U     =    -  (  BIN 7EE S2)  *G T*GN 

CALCULATE    GT 

DG    490     I=1,NC 

DO    490    J=1,NS 

PRC  (I,  J)  =  0.D0 

DC    i»8Q    K=1,3H 

PSC  (I,  J)  =  PHO  (I, J)  +G  (K.I)  *GN  (K.J) 


BGC(I  ,J)=-?RO  (IXJ)/E(I,I) 

"    TO    5C 
LIZE    ANE    FEINT 
IiBITE=2 


IF     (IDSTAE 
NO  SI H  A  LIZE 


.un.U|/i     1.11 

.Q.     1  )     GC    TO     500 

ANE    FEINT   OPT. 


SEG.    CLOSED    LOOP    BIGEN5YSTEH- 


C  — 

500 

510 
C  — 


520 


530 
C— ■ 


1VSRS2    SAVED    IN    HMORHI 


540 
550 


560 


CALL    CNOEM     (C3E,CWI,SC,  N  S  ,  I  3  a  ITS  ,  NSQ  ,DDD,Dl,D2,SHORH,»NOfiHI,FBGC, 
1AA,NC,NS) 
TaE    OPTIMUM    FEEDBACK    CONTHOL    GAINS 

■RITE     (6,1580) 

DC    510    1=1, NC 

BRITE     (6,1590)      (FEGC  II,  J)  ,J=1  ,NS) 

COMPUTE    MODAL    C    MATRIX       OPEN    LOOP    U-IN" 

I?     (IM     .HE.     1)     GO    TG    530 

IN    COMPUTING    MODAL    C    RECOMPUTE    0    CT-EN    LOCP    SINCE    HSORH    USED    TO    STORE 
0    5    O-INV     FOR    CLOSED    LOOP    SYSTEMS;    WNORMI    USED    TO    SAVE    U-INV    OPEN    LCCP 

DC    520     1=1, NS 

DO    520    J=1,NS 

WNCRM  (I, J)=WNCEMI  (I.J) 

CALL    MINV     (NSQ ,-NCRM  .US , DCD, D1  ,C2) 

CALL    MODE    (W  NC  £,M  ,  EBGC,  A  A  ,  NS  ,  NC  ,NS  ,  3) 

CONTIN  IT. 

TEE    CLOSED    LOOP    DYNAMICS    lIATF.IX 

DO    550    1=1, as 

DC    550    J=1,!.'S 

5011=0.  DO 

DO    540     :<  =  1,NC 

SOH=SUa+G  (I.K)  *F3GC  (K.J) 

ACL (I, J) =EA (I, J) +  SUH 

WRITE     (6.1600) 

CALL    3APRNT     (  M  E  ,  MH  ,  MH,5  ,  ACL  ,  4  ,  •  (5  (1X  ,  1FD1  3  .  6  )  )  ') 

IF     (IR.  NE.  1.  ANE.  IE.NE.3)      GO    TO    590 

DO    5o0    1=1, NS 

DO    560    J=1,N3 

GN  (I,  J)  =ACL  (I  ,  J) 

CALL    3ALANC     (  N  S  ,  NS  ,  GN  ,LO  W  .IHIGH,  D  1) 

CALL    3RTHES     (  NS  ,  NS  ,LCW  ,  I  HIG  H  ,  G  S,  D2) 

3  RTF  AN     (  N  S,  N  S.LOS,  IHIGH,  GN,  0  2,  5C) 


CALL 


C 


570 

580 
5S0 
6C0 
610 

620 

630 


CALL    HQR2     (HS  ,  SS  ,IOS,  IHIGH,  GH  ,CSH,CW  I.SC.I2HR) 

IF     (IESR    .NE.     0)     CALL    E3EXIT     (NS  ,  3H  ,  IEEE) 
CALL    9ALEAK     (  N  S  ,  NS  ,  LOW  ,  I  H  IG  H  ,  E  1 ,  NS  ,  S  C) 

NORMALIZE    ANE    PRINT   CLOSED    LOO?    SU30PT. 


REG.     2IGENSYSTZM 

IWBITS=3 

CALL   CNORM    (C iE  ,C3I , 2C, NS  ,1  WRITE , NSQ  , DDE , D 1 , D2 , i NORB , i NOR H I , FBGC  , 
1 AA.NC, NS) 
DO    570    1=1, NS 

IF     (CWR?I)  .LT. 0.0)     GOTO     570 
WRITS     (5,1610) 
RETURN 
CONTIN  OE 

I?     (IQ.NE.1)      GO    TC    590 
DO    580    1=1, NS 
DO    580    J=1,NS 
W11  (I,  J)  =SC  (I  .J) 

CALL    MINV    [SSQ,B11fNS,DDD,D1,D2) 
NOB=NO 

IF     (    NG    .EQ.     Q)     RETURN 
IF     (ISET.EQ.  1)     GO    TC    610 
CALL    3EAEG2     (  NS  ,  NG,  IG  AM  ,  G  AM) 
CONTINUE 

IF     (IOL    .EQ.     3)     GC    TO    620 
CALL    R  EADC    JNG.C) 
WRITE     (6,1420) 
DO    630    1=1, NS 
WRITS     (6,1390)      (GAM  (I,J)  ,J=1  ,NG) 
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If     (I3.NE.1)      GC    TC    640 

CALL    .1002     (HHCBHI,GAa,AA,BS,NS,HG,1) 

6U0  CONTINUE 

IF     (IOL     .EQ.     3)     BETOHN 

SSITE     (6,1430) 

DO  650  1=1.  MG 
650  IBITE     (6,1390)      (Q  (I,  J)  ,  J=  1,  IIG) 

IF     UIQ.FC.O)  .AbD.  (NG.EQ.O)  )     GC   TO    1260 

DO    obJ    1=1, HG 

DO    66  0    J  =  1,NS 

FBC (I, J)  =0.D0 

DO  SoO  K=1.NG 
660  PEC  (I,  J)  =  F-30  (I,  J)  *Q  (1,5)  *  GA  M  (o,X) 

DO    o70    1=1, MS 

DO    673    J=1,NS 

eg  (i.j)  =c.do 

DO    670    K=1,SG 

670         CO  (I,  J)  =CQ  (I  ,  J)  -GAM  <I,K)  *PBC  (K,J) 


IF     (IHEG    .EQ.      1)     GO    TO    69  0 

c— 

c 
c 

-CALCULATION    OF    FILTER    GAI MS  :F 

DC  KSTTriM        t*V      H^TTMST1  TCI  V       MS   ^1  T  T  TOM  T  S  M--- 

UMc.31.LUn      L.T      Hj  ii.i  &1  1U  h      i1Aaix.lUN  1AJ"*"" 

***F     AMD    FT    ARE    SAME    AS    FOB 

3 

c 

T"                                        ~~T 

CCNTFOL    3A3ILTOJIAM 

= 

c 

F                          -Gi1*C.*Gi1T     | 

***Q     IS    SG2NG    STATE    DISTURBANCE 

S 

c 

1                                                                     i 

RCOVABIAHCE 

= 

c 

1 

***R     IS    NOXNG    .lEASUEEtlZNT    NOISE 

= 

c 

1                                                                     1 

acovaai&acE 

= 

c 

|     -HOT*BIN*HO                  -FT 

***HC    IS    NOXMS    SEASOBESENT    JIAT?.IX= 

c 

—  —                                                         

***g:i  is  hsxijg  state  oistubbamce 

= 

c 

DI3TBIEUTI0M    MATRIX 

= 

CALL    P.SADF     (MG  ,SC) 
WEIT2     (6,1450) 

DO    6fi0    1=1. MO 

WHITE     (6,1390)      (3C(I,J),J=1 

680 

,MC) 

690 
C-- 

IF     (ITF2     .EQ.     C)     GO    TO    700 
MOI3E    TRAM3F 

EB    FOMCTIOMS 

700 


710 
C 


720 


730 

C  — 


740 

C-GO 
750 
C 


76  0 
C— - 


BHIT2     (6,1620) 

ITFX=2 

IZEHO=0 

CALL    TF     (MS,  :IS,MSQ,  ACL,  AA,MG,Gaa,3a,  MO  ,  HC  ,CM  ,I2ER0  ,  D  ,  3B,  CC  ,  CP  ,  WB  , 
1BI,CWR  ,  CBI.SC  ,JCF.RES,D  1  ,D2  ,  DDL,  EPS,  ITF2,ITFX) 

IF     (IHEG    .EQ.      1)     5ETURN 

COMTI'.IUE 

IF     (IREG    .EQ.      1)     GO    TO    930 

IF     (IR  .LT.2)     GC    TC    710 

CALL    REACFE     (MS,MC,FEG2) 

GO    TO    310 

CCNTIMUE 
THE    .lEASOREBENT    MATRIX      (HCT*RI N*HO===> SC 

DO    720     1=1, NO 

DO    720    J=1,MH 

FBC(I,J)  =BO(I,J)/SC(I,I) 

DO    730    1=1, AH 

DO    7.10    J=1,MH 

R8  (I*  1H,  J)=0.  DO 

DC    730     5=1, NO 

RM(I+;iH,u)=Ba(I+aB,J)-3  0(K,I)*EBO(K,J) 
Grt=Q*GHT===>CC 

DO    740    1=1 ,MS 

DO    740    J=1,MS 

HH  (I, J)  =EA  (I  ,  J) 

BM  (I+flH,  J+1H)  =  -EA  (J,  I) 

3H  (I,J-!-MS)  =CQ  (I, J) 

GO    TO    400 
BACK    TO    45C    TO     SET    UP    THE    FILTEE    H  AMI  LTC  NI  AN;     CALC.THE    FILTER    GAINS 

CALL    3GAIN     (8  ,  MS  ,  SC  .  NOB,  HH,  il  ,X,GN,G  H    ,  3.1 ,  »l  1  ,  D1  ,  CR  ,  CI  ,  PRO  ,  3HS  ,  D  2) 
CHECK     EIGENVECTORS 

IF     (IDE30G    -EQ.    0)     GO   TO     760 

HRIT2     (6,1570) 

CALL    BAPENT     (MS,  BS,  SS,9  ,  PBO  ,  »  ,  •  (9  (1X  ,  1PD1  3.6) )  'J 

CONTINUE 

IF     (IDSTAE    .EC.     1)     GC   TO    770 
NORMALIZE    AND    PBIMT    OPT.    ESTIMATCB    EIGEMSTSTEM 

IHBIT2=4 

CALL   CNOBM     (C E  ,CT  ,PBC ,NS , IS BITE , NSQ,  DDD,D1,D2,  3 NO RM , 3N03MI , HO , A A  , 
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1N0,SS) 
770    DC  780  1=1, J!H 

DO  780  J=1,NO 
780    FBC  (I,  J)  =*HO  (J,I) /BC  (J,J) 

DO  790  1=1, an 

DC  790  J=1,NG 

F3GS  (I  ,J)  =0.30 

DC  790  K=1,3H 
790    FBGEfl.J)  =EBGE  (I,C)*GN(I,K)*FIC{K,J) 

IF  (IDSTAE  .ZO.  1)  GO  TO  810 

WRITS     (6,1670) 

CALL    aSPEMT     (  fl  R  ,  Ah  ,  aH,5  ,  G  N,  4  ,  '  (5  ( 1X  ,  1  PC  1  3  .  6)  )  •  ) 

KBITS     (6,1630) 

DO    8  00    I  =  1,.1H 
800  X  (1,1)  =DSQHT  (GN  (1,1)  ) 

WRITS     (6,1630)      (X  il  ,1)  ,1=1, aH) 
810  WHITE     (6,1630) 

DO    820     1  =  1, a.4 
320          WHITE     (6,161*0)      (F  EG  E  (I,  J)  ,J=  1  ,  NO) 
C COIPUTI    aOD&I    K    2ATRIX       OPEN    LOOP    U-IN7    SAVED    IN    WNOaai    

IF     (IS     .HI.     1)     GO    TO    330 

CALL    aCDE    (WNOEHI,JBGE,  A&,KH,HH,NO,4) 

CONTINUE 
HESET     FLAG    ANE    F    MATRIX     FOR     ITERATIVE    DESTA  3ILIZATION    CASE 

IF     (IDSTAE    -~Q.    0)     GC   TO    350 

DC    34  0     1=1, MS 

DO    340    J  =  1,NS 

BA(I,J)=EA(I,J)  -Z  STORE  (I,  J) 

CONTINUE 

DO    370    1=1, NS 
DC    370    J=1,3S 

sua=o. o 

DC    36)    K=1,NO 

SOH*SOH*PEGE  (I,K)  *4C  (K,J) 

EEC  (I, J) =£A (I, J)  -SUM 

WRITE     (6,1631) 

CALL    RAPRNT     (  N  S  ,  NS  ,  NS  .5  .  PRO,  4  ,  •  (5  ( 1  X  ,  1  P  E  1  3  .  6  )  )  ' ) 

IF    (13    . LT.    2)     GO    TO    a90 

CALL    3ALANC     (  N S  ,  N S  ,  PRO , LO W, IH  IGH , D1 ) 

CALL    OBTEES     (  NS  ,  NS  .LOW,  I  HIGH  ,  PRO  ,  02! 

CALL    ORTRAN       NS  ,NS  ,ICH,I HIGH , EBO, D2, GH) 

CALL  3C32  (NS,NSrlOW,IHIGH#PHC,CR,CI,G»,IEER) 

IF  (IE  P.P.  .NS.  .G)  CALL  SHSXIT  (KS .PRO .IEBfi) 

CALL  BALEAK  (  NS  ,  NS  ,  LOW,  I  H  IGH  ,  D  1 ,  NS,  3  «)' 

WRITE     (6,1560) 

NOBHALIZE    AND    PRINT    SUBOPT.    ESTIMATOR    EIGENSISTSH 

IWHITE=5 

CALL  CNOEH  (C H  ,CI  .GH  ,NS , I  WRIT E ,NSQ, D DD, D1 , D2 , W NO Ha, W NO RMI, HO , A A , 
1NC,NS) 
DO  880  1=1, NS 

IF  (CH (I) .LT. 0.0)  GO  TO  880 
WRITS  (5,1660) 
RETURN 
CONTINUE 
GC  TO  900 

I?  (IO.SC.0)  GC  TC  1260 
913  1=1, NO 


830 

C  — ■ 


840 
850 


860 
870 


C 


880 

890 

900 


910 


920 

930 

C  —  • 


940 
950 


DC  910  1= 

DO  910  J=1,HH 
EHC  (I,  J)  =0.DO 
DO  910  K*1,NO 
ESC  (I,  J)  =  E*0  (I,  J)  +RC  (I,K)  *F3GE  (J,l<) 

do  920  1=1, aa 

CO    9  20    J=1,aH 

eg  (i.j)  =c.do 
DC  920    s=i,:io 

CQ  (I,  J)  =CQ  (I  ,  J)-FEGE  (I,  K)  *PaC  |K,  J) 
CONTINUE 
1HE    RaS    STATE    AND    COST  SOL    RESPONSES- 

ia=ia+  1 

GO    TO     (1CS0,1  C90,S4C,940)  ,    IH 

DC    950     1=1, NS 

DO    950    J=1,NG 

X  (I.J)  =0.0 

DO    950    K=1,NG 

X  (I, J)  =X  (I,J)  ♦GAM(I,K)*Q  (K,J) 
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960 


970 


980 


9  90 
10CC 


1010 
102C 


1030 
1040 


1050 
1060 


107C 


1080 

1090 
110C 


1110 
1120 


1130 

1Ufl 
1150 


1160 


DC   970    1=  1,NS 

DO    970    J=I,NS 

508*0. j 

DO    960    K=1,NG 

SOH=SOM-X  (I.X)  *GAK  ( J  ,X) 

PRO  (I,  J)  =SU.1  +  CQ  (I, J) 

EEC  (J,  I)  =ERO  (I, J) 

CQ  (I, J)  =S0.1 

CO  'J, I)  =  £C:i 

321  II,  J)  =  GH  (I,  J) 

¥21  (J, I)  =GM  (J  ,1) 

CALL    dlNV     (NSQ,W2  1,MS,DDD,D  1  ,  E  2) 

CALL    SC07     <NS,G2,«21  ,CH,CI, NS ,GH,»21  , CR , CI , PRO , GN) 

SHITS     (6  ,  1670) 

CML    RAESNT     (2H,?.HfJJH,5,GS,4,  •  (5(1X,  1ED13.6)  )  •  ) 

.SITS     (6,1680) 

CC    930    1=1, MH 


X  (1,1)  =  DSCsT  (GN  (1,1)  ) 

WEITE     (6,1690)      (X  (I,  I)  ,  1=  1 ,  a  H) 

if   (rg.sc-0)    gc  tc  1260 

DC    100  0     1*1,  MC 


DO     1000    J=1,NS 

SUH=0. 0 

DO    99  0    K*1,HS 

SOa=StJa+FEGC  (I,K)  *GN  (K,J) 

X  (I, J)  =SUH 

DC    1020    1  =  1, MS 

DC     1020    J=1,SS 

SUa=0. 0 

IF     (NC. EC.O)      GC    TC     1020 

do   ioio   k=i,:;c 

SUR=S'J?!+G  (1,5)  *X  (K.J) 

PRO  (I,  J)  =CQ>  (I  ,J)  *SU2 

CALL   JCOV     (NS,SC,V11  ,C¥H  ,CWI,NS,GH,W21,Cfl,CI,PHO,BA) 

IF     (NC.  EC. 5)      viC    TC     1C40 


DC 
DC 


1030    1=1, NC 
1030    J=1,SS 


B21  (I.J)  =C.O 

DC    1030    k=i,:js 

W21  (I,  J)  =Si21  (I  ,J)  +F3GC  (I  ,  X)  *BA  |J ,  X) 

DC    1060     1=1, NS 

DO    106  0    J=1,MS 

soa=o.o 

IF     fNC.EQ.O)     GC    TC    1060 

DC    10  5  0     K=1,NC 

SUM=SUK*G  <I,X)  *W2  1  (K  ,J) 

EEC  (I.J)  =SUS 

DO    1070    1=1, NS 

DO    1070    J=I,K£ 

EEC  (I,  J)  =EP.O  (I, J)  +CQ  (I, J)  +PRO  (0,1) 


PRC  (J, I)  =E?.0  (I, J) 

CALL   SCOV     (NS  ,3C,'*11,CWR  ,CB I, KS,SC, H  11  ,CSR  ,C3I  ,PRO,CQ) 

DO    1080    1=1, NS 

DC    1080    J  =  I,NS 

GH  (I,J)  =CC  (1,0)  -EA  (I,J)  -3A  (J,I)  +GN(I  ,J) 

GH  (J,I)*GH  (I.J) 

GO    TO     1 1 CC 

CALL   SCOV     fBS,SC,Hl1,CHE,C9I,H£,SC,i11,CBB,CHI,CQ,GM) 

IF     (NC  .EC.O)     GC    TC    1  150 

DO    1120     1=1, NS 

DC    1120    J=1,NC 

PRC  (I,  J)  =C.D0 

DO    1110     K=1,NS 

PRO  (I,  J)  =PRO  (I,J)  +GH  (I,  X)  *FBGC  (J,X) 

CONTINUE 

DO    1140    1=1, NC 

DO    1140    J=1,NC 

SC  (I.J)  =  C.D0 

DC    1130     K=1,NS 

SC  (I,  J)  =SC  (I,  J)  +FEGC  H,X)  *PRO  (K,  J) 

CONTINUE 


(13  EG 
f  If 


IF 

DC    1 160     1=1, MS 
DO    1160    J  =  1,NS 
CQ  (I,J)=GM(I,J) 
GO    TO     119C 


0)     GO    TO    1  170 
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117C 


1180 
1190 


1200 
1210 
122C 


1230 
12UC 


1250 
1260 
C 


WR 
CA 


aH,aE.5,GHf  4,  '  (5(1X,  IPC  13. o)  )  ') 


1270 
12SC 


1290 
C 


1300 
1310 


132C 
1330 


1340 


1350 
1360 


1370 


CC.  il, I)  ,SC(I,I) 
CC.  (l,I) 


C 

C6  7  0 
1380 
139  0 


'.ITS      (6,1700) 

iLL   RAPnNT     (hh,«, 
IF     (IB  .GI.2)     GC    TC    1  190 
CO    1180    1  =  1,  ,1B 
DC    1180    J=1,MH 
CQ  (I, J)  =GN  (I,  J)  +  G5  (I  ,J) 
CONTINUE 
WRITE     (6.1710) 

CALL    3APSST     (M  B,  HE.  3  E,5  ,  CQ,  4,  •  (5  ( 1X,  1PD  13.6)  >  • ) 
I?     (NC.EQ.O)     GC    IC    1210 
WHITE     (6,172  0) 
DC    120  0    1=1, SC 

WRITE     (6,1730)      (SC  (I  ,J)  ,  J=1  ,NC) 
DO    1220     1=1, NS 
CO  (1,1)  =DSQRT (CQ  (1,1).) 
If     (KC.  ECO)     GC    TC    12U0 
DO    1230    1  =  1, ;ic 
SC  <I,I)  =  CSQBT  (SC  (1,1)) 
BRITS     (6.1740) 
DO    125  0    1=1, NS 
IF     (I.LE.NC)      WRITE     (6,1750) 
IF    (I.  GT.NC)     WRITE    (6,1750) 
CONTINUE 
IF     (ITF3    .  ZQ.     C)     GO    TO     1 2  90 

FOR.1    CCHPENSATOH    FEOH     MEA3    IC    INPUT    AND    COMPUTE    TF 

DC  1230  1=1, as 
DO  1230  j=i,as 
sua=o. do 

DO    1270     Kal.SC 

SUK=SUM*FEGE  (  I ,  K)  *HC  (K,  J) 

CQ  (I,  J)  =ACL  (I  ,J)  -SOM 

WBITS     (6,1760) 

ITFX=3 

IZERO=0 

CALL    TF     (NS, NS  ,NSC,C:,AA, NO, FEGE,3M, NC,FBGC,C*,IZ2RO,0  ,B8,CC,CP 
1SR,  SI,  CViR  ,CWI  ,SC  ,JCF,a£S,C1  ,  C2  ,DDD,  E  PS  ,  IT  F3,  ITFX) 

CONTINUE 
COMPUTE    PSD    FUNCTIONS    OF    THE    CONTECLLED    SXSTEH 

IF     (IPSD    .ZQ.     0)     GO    TO     13  10 

IF    illO    .IT-    3)     GC    TC    1300 

CAlt    PSDCAL     (S,NS,BM,X,NC,GW ,G7,FBGC  ,  NO , H Y,H U , HO , F3GE, NG , 
1    GAM, ACL, 3A, WE  ,WI,D1  ,D2  ,  JCF  .BIS,  C,flC,BE,CC,  1        ,I?SD,INORX) 

CALL    PSDCAL     (  3  ,  S3  ,S  H  ,X,  S  C  ,  GW  ,  G7,FBGC  ,  NO  ,  H  Y  ,  d?  ,  .'10  ,F3G2  ,  NG  , 
1    GAS, ACL  .BA,WB,WI  ,D1  ,D2 , JCF, RES , Q, EC , HE , CC , 2        ,IPSD,INOEM) 

GO    TO     13  IC 

CALL    PSDCAL     (  M  ,  NS  ,  BR  ,X,  S  C.GW  ,  GV,FBGC  , NO , HY ,H U , HO , FB GE , NG , 
1    GAM,ACL,BA,WR,WI  ,D1  ,02  ,  JCF  ,  RES  ,  C,RC  ,  BE  ,  CC,  IYU  ,  IPS  D  ,  INORM) 

IF     (ISS    .£0.     0)     3ET0RN 

IF     (NC     .NE.     0)     GO    TC     1330 

DO    1320     1  =  1, NS 

DO    132  0     J=1,NS 

ACLJI.  J)  =BA  (I  ,J) 

CONTINUE. 

CALL    3INV     (NSQ,ACI,MS,DDD,D1  ,  C2) 

CALL    REACH     (HG.HB) 

WRITE     (6,1770) 

WBITE     (6,1780) 

DO     1340    1=1, NS 

WI  (I)  =0.  0 

DO    13U0    J=1,NG 

WI  (I)  =WI  (I)  -t-GAH  (I, J)  *WR  (J) 

DO     136  0    I=1,SS 

CB  (I)  =0.  0 

DO     1350    J=1,NS 

CH(I)=CB  (I)  -ACL  (I, J)  *WI(J) 

WRITE     (6,1390)     Ca  (I) 

DO     1370     1=1, SC 

CI  (I)  =0.  0 

DO     1370    J=1,NS 

CI  (I)=CI  <I)*FEGC  (I,J)  *CB  (J) 

WRIT2     (6,1790)      (CI  (I)  ,1=1  ,SC) 

BETORN 


(iR(I)  ,1=1  ,SG) 


FCBMAT     (2X, 1P6E14.6,/,2X,  6D14.6) 
FORMAT     (//,5X,U5HCPEN    LOOE    DY&AMICS 
FCBMAT     (  10  (2X,0PC11.  4)) 


flATBIX F. 


//) 
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1400       FORMAT     (//,  5  X  ,  45  HIRE    CONTROL    DISTRIBUTION    MATRIX G..,//) 

1410       FORMAT     f//,5Xr45HTHE    CONTROL    COST    MATRIX 3..,//) 

1420       FORMAT       //, 5X  ,  45 HERCCSSS     NOISE    DISTRIBUTION    MATRIX GAMMA..,//) 

1430       FORMAT     (//,  5  X  ,  45  HEO  W  ER    SPECTRAL    DENSITY    -    PROCESS    NOISE C..,//) 

1440       FORMAT     (  //  ,  5  X  ,  45  HME  A  SURE  MENT    SCALING     MATRIX H..,//) 

1450       FORMAT     (//,  5X  ,  45  HPCW  ER    SPECTRAL    DSKSITY-flEASOSSHEHT    NO  ISE.  .  H  .  .  ,//) 

146C       FORMAT     (//  ,  5  X  ,  45  HC  IT  EUT    COST    MATRIX A..,//) 

1470       FORMAT     (//, 5X , 45 RMEA3UR S M EN T     FEEDTURCUGH    MATRIX D..,//) 

148C       FORMAT     (//,25X.23H DESTABIIIZATIO N    CASE ,// ,  1  OX,  39HTHS    FOLLO 

1WING    VALUES    HILL    EE    ADDED    DO  <i  N ,/ ,  10X  ,  -iS  HTHE    DIAGONAL    OF    THE    "F"    MA 
2TRIX    TO    DESTABILIZE    IT.  ,  /  ,  1  0  X  .4  1  HOPT  IM  A  L    GAINS     FOR    THE    DESTABILIZE 
3D    SYSTEM,/. 10X.39EARE   THEN    USED    AS    FIXED    SUBOPTIMAL    G AINS , / , 1  OX , 28 
4HF0R    THE    SYSTEM    CALCULATIONS..//) 
1490       FORMAT     (///43H    PROGRAM    TERMINATING    DUE    TO    UNSTABLE    SYSTEM) 
1500       FORMAT     (//,2X,31HCEEN    LOOP    TRANSFER     FUNCTIONS...) 
1510       FORMAT     (//,5X,22H    EU LER- L AGH A NGE    SYSTEM    MATRIX...,//) 
152G       FORMAT     { //, 1 X , 43HEIG ZNV ALUES     AND    EIGENVECTORS    OF    THE    2N    X    2N,/,2X, 

145HE0LER-LAGRANGE    SYSTEM     AFTER    HQR2 ,//) 

1530       FORMAT     (  1X,  1  P  21 1  3  .  6) 
154C       FORMAT     (IX) 

1550       FORMAT     (//, 2 X , 4  1  K EIG ENS Y STEM    OF   OPTIMAL    REGULATOR ,//) 

156C       FORMAT     ( //,2  X  ,  4  1  HEIG  ENS  YS  TS  M    GF    OPTIMAL    ESTIMATOR ,//) 

1570       FORMAT     (//,5X,39H    EIGENVECTORS    FROM     RGAIN    PRIOR    TO    CNORM,//) 

158C       FORMAT     (//, 1 X , 57H1HZ    OPTIMAL    EEEDBACK    GAIN    CONTROL    MATRIX. .. C=BINV 

1*GT*S.  ..  ,//) 
1590       FORMAT     (  1  C  {2  X  ,  1PD  1 1 .  4)  ) 

160C       FORMAT     <//,2 X .45 HTHE    CLOSED    LCCE    DYNAMICS    MATRIX     F-G*C..,//) 

1610       FORMAT     (///,6GH         PRCGRAM    TERMINATING    DUE    TO    UNSTABLE    CLOSED    LOOP 

1  SYSTEM) 

1620       FORMAT     (//, 2X , 6  1 RNOI3E    TRANSFER    FUNCIICNS     ,32HTHROUGH    THE    CLOSED    L 

100P  SYSTEM.. ,//) 

1630   FORMAT  (//, 5 X , 45h FILTER  STEADY  STATS  GAINS K..,//) 

1640       FORMAT     (1X,2X,1P6C14.6) 

1650       FORMAT     (// , 1 X , 4 3 HTH E    CLOSED    LCCP    FILTER    DYNAMICS    MATRIX    IS..,//) 

16^0       FORMAT     (////,  a3R     9FCGRAM     TERMINATING    DUE    TO    UNSTABLE    7ILTSS) 

1670       FORMAT     (//, 5  a , 45 H THE    COVA5IANCZ    OF   T  HE    ESTIMATION     ERROR P..,//) 

16ri0       FORMAT     l//,5X .  45  HBMS    VALUES    OF    THE    ESTIMATION    ERROR ,//) 

169C       FORMAT        (5  (1  X  ,  1PD  1  3  .  o)  )  ) 

1700       FORMAT      (// , 5 X , 45 HTH E    CO V  A RI ANCZ   OF   T HE    ESTIMATE XHAT..,//) 

1710       FORMAT     (//, 5X , 45HTHE    STATE    COVARIANCE    MATRIX X=XHAT    *    P ,//) 

1720       FORMAT     (// , 5 X  ,  45HTH E    CO  NT EOL    CCVARIANCE U=C*XHAT*CT ,//) 

1730       FORMAT     (1E6D14.6) 

174C       FORMAT     (//,2 X  ,  1  8H STATE    RMS    RESECNSE, 20X , 20 dCONTROL    RMS    RESPONSE,/) 

1750       FORMAT        1X  ,  1  ?  E  15  .  7  ,  2  5X,  D  1  5.  7) 

176C       FORMAT    ]// ,5 X ,5 0HCC M EENS ATOH    TRANSFER    FUNCTIONS    FROM    MEAS.     TO    INEU 

1T,/,5X,52H U/Z    =    -C*  (SI-F+G*C  +  K*H)  INV*K ,//) 

1770       FORMAT     ( // .  2X  ,  46  HST  E  ADY    DISTUREANCE    VECTOR !>..,// 

1  .  10  (1X,  1  ED12.4/)  ) 

1780       FORMAT     (//, 5X , 45 HST E ADY     STATS    VALUES    OF    STATE    VAR.     ARE //) 

179C       FORMAT     (//  ,  5  X  ,  47H  STE  AD  Y    STATE    CONTROL    IS    ,/ 

1/10  (1X,  1EE12.  4/)  ) 
1800       FORMAT     (// , 5 X  ,  49  RENTER    THE    MAGNITUDE    OF    THE    DEST ABILIZ ATIO N    VECTCR 

1  ,/,8X,47liTO    BE    ADCEE    DOWN    THE    DIAGONAL    OF    THE    "F  "-MATRIX  ,/,  3X  ,  1 3  HT 

20  DESTABILIZE  IT.,//) 
ENC 


90 


10 

20 
30 


SUE 

SEA 

Dirt 

NU= 

DC 

IF 

DC 

H8I 

WEI 

NU  = 

BET 

FOR 

END 


ROUTINE    HAPFNT     f  NH&X  .  &  ,H  ,  L,4,  IDIM  ,  FMI) 
L*H     A  {NIUX  ,8) 
E1ISION    FMT  (IEIX) 
L 

20    SL=1,N,L 
{NU.Gl-II)      NU=!i 
TO    1=1  ,3 
[TB     (6#rHTJ      (A  (I,J)  ,J=NI,  HO) 

=  ?JU+L 
rURK 


91 


SUBROUTINE    RGAIN     (H  ,  KS,  NC  ,N  C3  ,  »  S  ,  91 ,  VF,  GN  ,  W  11  ,  TCB  ,  3  2  1  ,  LT,  C  ,  CI  ,CT  ,3 
1  HS,MT) 


IMPLICIT    REAL*8     <A-H,0-Z) 
DIHEHSIOH    "IR  (tl)  ,*I  («{  ,7F  (!1,3)   ,GN  (NS,  NS) 
DIMENSION    »1  1  (SS,NS)   ,TC3  (.1,  M)   ,S21  (NS  ,  NS)  , 
DIMENSION    C(NS)  ,CI  (NS)  ,CT  (NS  ,  NS) 


LT(N5)  ,HT{NS) 


K=1 
KP  =  1 
KH=1 
NRZSV=0 
NCPZE7=0 
10  I?     (K.GT.3)     GC    TO    210 


C    CHECK    POH    EIGVAL    AT    CF    NEAR     J-OMEGi    AXIS     TO    INCLUDE    IN     E-L    SIGSTS 

C       TUHN    FIRST    ONE    POSITIVE    AND    SECON'C    ONE     NEGATIVE 

c 

EIG7R=  CAES  (MR  (K)  ) 

IF     (EIG7R.GE.  1.D-10)     GO    TC    60 

IF     (MI(K))     40,20,40 
20  NRZEV=SRZEV+ 1 

IF     (NRZEV.GT.  1)     GC    TO    30 

MR  (K)  =EIGVR 

GC    TO    80 
30  MR  (K)  =-EIGVR 

WRITE     (6.290) 

GC    TO     15C 
1*0  NC2ZEV=NCEZEV  +  1 

IF     (NC?ZEV.GT- 1)     GO    TO    50 

MB  (X)  =  EIGV5 

MR  (Kf  1  )  =EIG7R 

GC    TO     110 
50  MR  (K)  =-EIG73 

MR  |K*1]  =-EIGVR 

B2TT2     (6.300) 

GC    TO     180 
60  IF     (MR  (K)  )     140,70  ,70 

70  IF     (WI(K)j     110,80,110 

c EIGENVECTOR    FOR    REAL    EIGE  NV  ALU  E  ,  ?OS  IT  IVE 

80  IF    (NOB.  EC. 0)      GO    TO     100 

DO    90    J=1,M 
90  TCE(J,  KP)=VF  (J,K) 

100  KP=K?+1 

K=K+1 

GO    TO     10 
c EIGENVECTOR    FCR    COMPLEX     EIG  ENV  ALUE  ,  POSITI V  E    REAL    PART  — 


110  IF     (NOB. EC. 0)      GO    TC     130 

DO     120     J=1,3 

FR  =  VF  (J,K) 

FI  =  -VF  (J,K+1) 

TC3  (J, KP) =?R  +  FI 
120  TCr    J,  :<P*1)  =rR-FI 

130  KP=K?+2 

K=K*2 

GO    TO     10 
140  IF     (MI  (K)  )     180,  150,  180 

c 1 EIGENVECTOR    FCR    REAL     EIGENVALUE, NEGAI IV S    REAL    PART- 

150  C  (KN)  =MR  (K) 

CI  (KN)  =SI  (K) 

IF     (NOB.NE.O)     GO    10     170 

KNS=KN+NS 

DO    160     J=1,3 


FCR    C0KPL2X    EIGENVALUE, NEGATIVE    REAL    PART 


160 

TC3  (J,KNS)=VF  (u,K) 
KN=KN+  1 

170 

K  =  K+1 

GO    TO     10 

180 

SE=MR(K) 

RI  =  MI (K) 
C  (KN)  =  RR 

C (KN+1 ) =RB 
CI  (KN)  =RI 

CI  (KN+  1)  =-P.I 

IF     (NOB.NE.O)      GO    T 

KNS=KN*NS 

DC    190     J=1,M 

ZOO 
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190 
200 


210 
C  — - 


220 
C  — ■ 


230 
240 


250 
260 
C— - 


270 


280 


C  — 

290 

300 


FE  =  VF(J,K) 

FI=-VF  (J  ,K*1) 

TCE(J,KNS)=FR  +  FI 

TC3  (J,KN2+1)  -FH-FI 

KS-KH+2 

K=K  +  2 

GC    TO     10 

CQNTIN UE 

IF     (NOB.  NE.O)      GO    TO     2U0 
FORMATION    OF    SM  1 

DO    220     1=1, NS 

DO    220    J=1,NS 

W11  (I,  J)  =TC3  (I.J+NS) 

CT(I,J)  =»11  (I, J) 
FORMATION    OF    «2  1 

DC    230    1=1, MS 

DC    230    J=1,NS 

W21  (I.J)  =1C3  (I  +  NS.J+KS1 

IF    (NOE.EC..0)     GO    10    260 

DO    250    1=1, NS 

DO    250    J=1,MS 

H21  (I,  J)  =-IC3  II.  J) 

W11  (I,  J)  =TC3(I+NS,J) 

CONTINUE 
INVERT    H1 1 

NSQ=N5*VS 

CALL    MIN7     (NSC,U1  1 ,  NS, D ETC, LT ,MT) 
CALCCLATE   THE    RGAIM     MATRIX- 
DC  270   11=1, as 

DO    270    JL=1,NS 
GN(IL,  JL)»Q.D0 

DO    270    KL=1 .MS 

GN(IL,  JL)  =  GN  (IL,JL)  +W21  (IL,KL)  *H  11  (KL.JL) 

IF     (NOB. EC. 0)      RETURN 

DO    280     1-1,  HS 

DO   230    j  =  i.;:s 

ct  (i.j) -mi  (J, i) 

HEIURN 


FORMAT     (  1  X  ,5  1  R    EOIER-LAGRANGE    EQUATICNS    HAVE 
1  1UH    OB    NEAri    " 


A    REAL    EIGENVALUE    AT, 


ERO./) 
FORMAT     (1X,49H    EULER-LAG  R  ANG  S    EQUATICNS    HAVE    A    COMPLEX    PAIR    OF    ,  UO 
1HEIGENVALUES     Al    OB    NEAR    T  !?£    J-CMEGA     AXIS.) 
END 
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SUBROUTINE    HINV     (8SC.  ,  A.  N  .  D,L.  E) 
IHFLICIT     HEAL*8     (A-H,Q-2) 
DIMENSION    A  (NSC.)  ,L  (N)  ,M  (N) 
DCUBL3    PRECISION     A,  C  .BIoA  .HOLD 
NK=N*« 
D»1.  j DO 
NK=-N 

CO    180    K=1,N 
NK=NK+  N 
L  (K)=K 
a  (K)  =  K 
KK=NK*K 
BIGA=A  (KK) 
DC    20    J  =  K,N 
IZ  =  N* (J-1) 
DC    20     I=K,N 
IJ=IZ+T 

IP     (DAES  (EIGA)  -CAE5 (A(IJ)  ))      10,20,20 
10  3I"A=A (IJ) 

L(K)=I 

a  h)  =j 

20  CONTINUE 

C INTEECHAHGE    BCWS 

J  =  L(K) 

I?     (J-K)     50,5C,3C 
30  KI=K-N 

DO    40    1=1, N 

KI=KI+S 

HOLD=-A  (KI) 

JI=iCI-K«-J 

A  (KI)  =A  (JI) 
40  A(JI)  =  HOLE 

c INTERCHANGE   CCLDHNS 

50  1  =  3  (K) 

I?     (I-K)      60,30,60 
60  JE  =  N>(I-1) 

DO    70    J=1,N 

JK=NK+J 

JI=JP+J 

HCLD=-A(JK) 

A  (JK)  =A  (JI) 
70  A  (JI)  =  HOLE 

C EIVIDE    COLUMN    3Y     MINUS     PIVOT 

C (VALUE    CF    PIVOT    ELEMENT     IS    CONTAINED    IN    3IGA) 

80  IF    (3IGA)     100, 9C, 100 

9  0  D=O.0DO 

3E103N 
100  DC    120     1=1, N 

IF     (I-K)      110,12C,110 
110  IK=HK+I 

A  (IX)  =A(IK)/(-3IGA) 
120          CONTINUE 
c REDUCE    MATRIX 

DC    150    1=1, N 

IK=NK+I 

HOLD=A  (IK) 

IJ=I-N 

DC    150    J=1,N 

IJ=IJ+  N 

IF     (I-K)      130,  15C,  130 
130  IF     (J-K)      140,15C,1U0 

140  KJ=IJ-I+K 

A  (IJ)  =HOLD*A  (KJ)  +  A  (IJ) 
150          CONTINUE 
c DIVIDE    BCW    3T     EIVGT 

KJ=K-N 

DO     170    J  =  1,N 

KJ  =  KJ+H 

IF     (J-K)      160,170,160 
160          A  (KJ)  =  A(KJ)/BIGA 
170         CONTINUE 
c PRODUCT    OF    PI  VOTS 

C REPLACE    PIVOT    3Y     RECIPROCAL 

A  (KK)  =  (1  .CDO)  /EISA 
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180 
C— ■ 


CONTINUE 


K  =  N 
190  K=  (K-1  ) 

I?     (K)     260,260,200 
200  I=L(K) 

IF     (I-K)     230,230,210 
210  JQ  =  NMK-1) 

JR=N* JI-1J 

DO    22d    J=1,N 

JK=JO*-J 

HOLD=A  (JK) 

a  (j:<)  =  -\  (Ji) 

220  A  (JI)  =HOLD 

230  J  =  M(K) 

I?     (J-K)      190,190,240 
240  KI=K-'.i 

DO    250    1  =  1, N 

KI=KI*N 

HCLD  =  !V  tKI) 

JI=KI-K+ J 

A  (KI)=-A  (JI) 
250  A  (JI)  =  HOLE 

GO    TO     190 
26  0  K  =  'J 

BETUHH 

5NC 


■FINAL    ROW    AND    COLO. IN    INT ERCH \NGE- 
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10 


20 


30 

uo 

50 
60 
70 
30 


90 


100 


110 
120 
130 


140 
150 
160 

170 


180 
190 


:  VL2  (I)  *7E2  (J) 

:  +VL2jI)  **i+?H2  <J) 

:-3**2 


>C)/D 


SUEaOOTINE   SCCV     (SL , 5L, WLI, V"L 1 , VL2. H B.HB.HRI , 78 1 , 7B2,Q,X) 
REAL*8     7L1  (NL)  ,  VI  2  (  N  L)  ,  WL  (N  L  ,  NL)  ,  WLI  (ML,  ML)  ,  X(NL,MR)  ,Q  (HL,MR) 
1  VS1  (NS),VR2(NP),iiB(MR,NR)  ,  HFI  (MB,  NB) 

REAL*8     A,c,C, E,K1,K2,K3,K4 

DO    20    1=1, NL 

DC    20    J=1,NR 

X  (I.J)  =  0. 

DO    20    11=1, NL 

X  (I,  J)  =X  II,  J)  +  SLI  (I,  II)  *Q  (I  I,  J) 

DC    40     1=  1,NL 

DO    40    J=1  ,NR 

Q  (I.J)  =0. 

DO    3  0    JJ=1,HR 

Q  (I.J)  =0(1,  J)   +  X  (I,  J  J)  *SRI  (J,  J  J) 

COSTIM02 

1=1 

IP     (VL2(I))     6  0,1  1  C  ,60 

J=1 

IF     (V32(J))     3C,S0,80 

A  =  VL1  (I)  +  VP.1  (J) 

B«-2.*~ 

C=A**2  *-VL2(t)  **i  +  7S2  (J)  **2 

D=C**2- 

K1=A*C/D 

K2=-  (V32  (J)  *C+VL2  (I)  *B)  /D 

K3  =  -(732  (J)  *E+VL2  (I)  *C 

K4=-A*B/E 

11=1+1 

J  1=J+1 

X  (I,  J)  =+«1*0  (I,  J)  +  K2*Q(I  ,  J1)  +  K3*Q  (II  ,J)  +  K4*q  (11,  J1) 

X  (I,J1)=-K2*0  (I,J) +K  1*0  (I,J1) -K4*y (I l,j)+Ki*y (II ,J1) 

X    I1,J)=-KJ*';  fl,  J    -K4*Q  (I,J  1)  +K1*Q    I  1,  J)+K2*Q(I1  ,J1) 

X  (I1.J1)  =+KU*<J  |I, J)  -K3*U  (I,  J1)-K2*-^(I1,  J)  +K1*Q(I1,J1) 

J=J  +  2 

GO    TO     IOC 

A=7H1 (J)  +  VL1 (I) 

B=A**2+VL2  (I)  **2 

K1=A/B 

K2=VL2  (I)/3 

X  (I,  J)  =K  1*0(1,  J)  -S2*C.(I+1,J) 

X  (1+1, J)  =K2*Q  (I,J)+K1*Q (1  +  1  , J) 

J  =  J+1 

IF     (J.  LB.  MR)     GC    TC    7  0 

1=1  +  2 

GO    TO     160 

J  =  1 

IF     (VR2(J))      13C,  140,  130 

A  =  VR1  (J)  +VL1  (I) 

E=A**2+VR2(J)  **2 

K1=A/3 

K2=VR2  (J)/B 

X(I,J)  =  K1*Q(T,J) 

X (I,J+ 1) =  K7' 

J=J+2 

GC    TO     150 

X  (I, J)  =Q  (I, J)/  (VE1  (J1+7L1  (I)  ) 

J=J+1 

IF     (J. LB. MR)     GO 

1=1+1 

IF    (I.L2.ML)     GC 

EC    170     1=1, ML 

DO    170    J=1,MR 

Qd.J)  =0. 

DO    170    11=1, ML 

Q  (I.J)  =5  (I,*)  +«L(I,II)*X  (II,  J) 

DO    190    1=1, ML 

DC    190    J=1,MR 

X  (I.J)  =0. 

DC    180    JJ=1,NR 

X  (I,  J)  =X  (I,J)  +Q  (I  ,JJ)*«R  (J,  JJ) 

CCNTIMOE 

RETURN 

ENE 


K2*C  (I,  J  +  1) 
■Q  (I, J)  +K1*Q  (I,J+1) 


TC 
TC 


120 

50 
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SUBROUTINE    MODE     IINCHH.G  ,GHOHE,  215  ,  N1  ,  N2,ICCN) 

C  = 

C  MNORW       rSANSFORHAIICB    MATRIX    0     CB    D-INV 

C  bS               NO.    Or    STATE 

C  NC                MO.        CF    INFUTS    OP    OUTPUTS 

C  ICON      C0NT3CL    FLAG    TC    INDICATE    WHICH    TRANSFORMATION                                                = 

C  0     =        MODAL    G                                                                                                                                              = 

C  1    =      EOjAI    gama 

C  2    =       MODAL    H 

C  3    =       30DAL    C 

C  U    =       MODAL    K                                                                                                                                       = 

C  5    =       CONTROL    EIGENVECTOR     SATHIX 

C  6    =       HEAS0EE3EHT    EIGENVECTCS    MATHIX                                                                    = 

IMPLICIT     HEAL*i (A-H.C-Z) 

DIMENSION    SNQBH(HS,NS)  ,  G  (  S1  ,  N2)  ,  GNOR  M  (  N  1 ,  N2) 
DO    10     1=1, N1 
DO    10    J=1,N2 
10  GNORM (I, J)=0. 

iecint=iccn+i 

go  to  (20, 20, 90,30,20,90  ,90)  ,  ipcint 

20     DC  30  J=1,N2 

DO  30  1  =  1  ,;is 

DC  30  K=1,NS 
30     GNORM  (I,  J)=GNCEH  (I,J)«-WNOBM  (I  ,  i<)  *G(K,J) 

GC  TO  (40,70,SQ,9G,80) ,  IPOINT 
40     1BITS  (6,170) 
50     DO  60  1=1  ,NS 
60     WHITE  (6,230)   (GSCE  H  (I,  J)  ,  J=  1  ,  N2) 

RETURN 
70     WRITS  (6,180) 

GO  TO  50 
30     WHITS  (6,240) 

GO  TO  5  0 
90     DC  100  J=1,NS 

DO  100  1=1,31 

DC  1C0  K-1,NS 
100    GNORM  (I,  J)=GNCHM  (I,  J)+G  (I  ,K)  *WKCRM  (K  ,  J) 

GC  TO  (1  10,1  10,  11C, 120,  1 10,  13C,14C)  ,  IPOINT 
110    WRITE  (6.190) 

GC  TO  T5C 
120    SHITE  (6.200) 

GO  TO  15C 
130    WHITE  (6,210) 

GO  TO  15 C 
1U0    WHITE  (6,220) 
150    DO  160  1=1. HI 
160    WHITS  (6,230)   (G  8CHH  (I,  J)  ,J=  1  ,  NS) 

RETURN 

C 

170         FORMAT     1//.51  .U5HKCD AL    CCNT20I    DISTRIBUTION    MATRIX TT*G..,//) 

180  FGEMAT     (// ,  5  X  ,  5  C  KMO  D  AL    PROCESS    NOISE     DISTRIBUTION    MATRIX TI+GAE. 

190  F6HMAT  (//,5X,U5HKCDAL    MEASUREMENT    SCALING    M ATRI X. . . H  (3AR )  *T . .  , //) 

200  FORMAT  (//,5X,45HIHS    HODAI   CO  KTHOL   G  AINS C*T..,//) 

210  FORMAT  f //, 5X , 45 RCC NTROL     EIGENVECTOR     MATRIX C*K..,//) 

220  FORMAT  (//, 5 X  ,  45H ME  A  SURE M ENT    EIGENVECTOR    MATRIX H (3AR)  * M . .  , //) 

230  FOHMAT  ( 11, (2X .  1P6D 1 1.6) )  „,„.„  ,    , 

240  FORMAT  (//,5X , 45HBCD Al    FILTER    STEADY    STATE    GAINS TI*K..,//) 

END 
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SUEROUTIKE    CMC  EM     (HZ ,WT , VEC, HS,IHBIT E, NSQ,DDD, 01 , D2 , i N OHM , 3N0BBI,H 

■  C  f  Cil  r  9   I  /  fl&j 

c 

C  «Z  (I)  SEAL    PART    OF    I-1R    EIGENVALUE 

C 

C  WT (I)  CCMFLEX   PART    OF    I-TH    EIGENVALUE 

C  — 

C  VEC  MATRIX    OF    2IGUT     EIGENVECTORS    STORED    IS    REAL    FORM 

C  FF.CH    HQR2 

C  NS  NO.    OF    STATES 

C 

C  IS  RITE  FLAG    TC    CONTROL    FORMATS    FOR    DIFFERENT    EIGHEHSXSTEHS* 

C 

C  iNORK  NORMALIZED     MATRIX    U    CF    RIGHT    EIGENVECTORS    STORED 

C  3¥    COIUMNS    IN     FEAL    FORM 

C  3N0RHI  U-INVEF.SE     2*C0NGUGATE    OF    LEFT    EIGENVECTORS 

C  STORED    BY    ROM    IN     REAL    FORM  = 

C  NSQ,  EED,  D1  ,E2    -     ARGUMENTS    PASSED    TO    MINV 

C  =  ===  =  =====  =  ====  =  ==  =  =  =  =  =  =  ====  =  ==  =  ======  =  ===  =  ====  =  =  ====  =  ==  =====  ====  =  == 

IMPLICIT    REAL*fl     (A-H,0-Z) 

HEAL* 3     FIELD, CCHHA,S EMCOL .SIGHT, FMT 

DIMENSION    4Z  (NS)  ,  "«I  (NS)  ,  V  EC  (NS,NS)  ,3  NORM  (NS,  NS)  ,  iHOBMI  (NS,  NS)  ,STOB 


DIMENSION    AZ  (NS)  ,  "«Y  (NS)  ,  V  EC  (NS,NS)  ,3  NORM  (NS,  NS 
1E  (6)  ,31  (NS)  ,  D2  INS)  ,  FMT(  1ft  J  .HO  (N1  ,N2)   ,CM  (N1  -N2) 

data  field/She  12. 5/, com m a/3 h,  ',',/, 5£acoL/5a,« 


,/, HI3HT/1H) /,FMT/ 
16H  (1X,  1P  ,13*1H    /.SSaiND/UH,'  : •/ 
C NORMALIZE    COMPLEX    EIGENVECTORS     31    LARGEST    ELEMENT 

KK  =  0 
LB=0 
LC  =  0 

EG    50    K=1,NS 
IF     (KK.2Q-1)      GC    TC    40 
IF     (DABS  (HT(K)  )  .LI.  1.D-  10)     GO    10    50 
LC=LC+ 1 
EHAX=0. DO 
DO    20    1  =  1, NS 

C1!0D=VEC  (I,X)  **2+VEC(I.K+1)  **2 
IF     (CMOD-EMAX)     20,10,10 
10  EMAX=C30E 

a=i 

20  CONTINUE 

VME=V2C  (S,X) 

V8I  =  VEC  (M,X+1) 

CO    30     1=1,  NS 

VH=VEC  (I  ,R) 

VI  =  VEC  (I,S*1) 

VEC3N=  (VH*VMR+VI*VMI)/EMAX 

VECIN=  (-VE*7MI+VI«VMR)/EMAX 

MNORM (I,K) =VEC5N 

HHOBH  (I.K  +  1)  =VECIN 
30  CCNTINOE 

KK=1 

GO   TO    50 
40            KR=0 
50             CONTINUE 
C NCEHALIZE    HEAL    EIGENVECTORS    BX    THE    TOTAL    LENGTH 

DC    30     S=1,NS 

IF     (DABS  (HX(K)  )  .GS.  1  .D-10)     GO    TO    30 

LK=LR*  1 

BEBOD=0.CC 

DC    60     1=1, NS 
60  BEMOD=VEC  <I,K)  **2  +  REMOD 

BMOD=DSQBT  (REMOE) 

DO    70    1=1, NS 

RVEC=VEC  (I,X)  /EKCE 

3NCRM(I,K)=R7EC 
70  CONTINUE 

30  CONTINUE  - 

GO    TO     (90.100,110,120,130)  ,    IWFITE 
90  HBITS     (6,320) 

GO    TO     140 
100  SBITE     (6,330) 

GO    TO     14  c 
110  MBIT  2     (6,340) 

GO    TO     14C 
120         WBITE     (6,350) 
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130 

140 


C 


GC    70     140 
WRITE     (6,360) 
KK=0 
NPRTW=0 
MFSTS-  1 
DO    180    I»1.HS 
IF    (KK.EQ.l)     GC 
IF    Ida  as  (KT<I1  ) 
PRINT    oaT     NO    .ICfl 
IF     (NPHTV.LT.  5. 


TC     170 
.G1.1.D-1 

£  than  6 

oh.  (nertw.  eq.5 


)     KK=1 
CSDS  ,    SOT 


SEPARATING    COMPLEX    EIGVAL 

2ND.KK  .EC..0)  )     GO    TO     150 


150 


160 


170 
130 


190 

200 

210 

220 
230 
240 

250 

260 

270 

280 
C— 

290 


300 


310 


FMT  (NFMTW-H)  =  RIGHT 

WRITE     (6, FMT)       (STCSE  (J)   ,  J=  1  ,  N  £  ETW) 

NPRTW=0 

NFMTW=  1 

HPRTH*HPRTW+ 1 

NFMTW=N7MTW*1 

IF  (KK.EC.1)  GC  TC  160 

STORE (NPFTWJ  =WZ  (I) 

FMT  (NFMTfe)  =  PIILD 

NFKTW=  SFETW+1 

PHTJNPaT«)»SEHCOl 

GC    TO     180 

STORE  (NPHTVi)  =i2(I) 

FMT  (M?MTW)=FIFIC 

FMT(NFMT5*1)  =CCMMA 

STORE (SPfiTW+1)  =SY  (I) 

FMT  (BFMTS+2)  =FIELE 

FMT  (NFMTW+3)  =S2MCCL 

HPETVJ=NFBTH*3 

HEETW=!IPBTW+1 

GO    TO     18C 

kk=q 

CONTIN  UE 

FMT  (NFMT3)  =SEMENC 

FBI  CIFMTW  +  1)  sRIGHT 

whit; 

II 
Wl 

GC    TO     20C 
WHITE     (6,330) 

CALL    2  APR  NT     (  N  S  .  NS  ,  MS  .6  ,  S  NO  RM  ,4  ,  •  (6  (  1X,  1  PD  1  3  .  6  )  )   '  ) 
GC   TO     (230,210,210,220,220),     ISRITE 
CALL    MODE     ( I  NO  RM  ,HO  ,  CM,  MS  ,  N  1  ,  N2  ,  5) 
GO    TO    23  0 

CALL    MCDE     (W  NC  HM  ,  EO  ,  CM,  N  S  ,  31  ,  N  2  ,  6) 
GO    TO     (24C. 250, 26C  ,270,280)  ,     IHRITE 
6,390) 


'1l 
■HI 


EITE     (6, FMT)       [STCR  E  ( J)   ,  J  =  1  ,  N  P?TW) 
F     (I8EIT2.SE. 1)     JO    TO    1"0 
RITE     (b,370) 


WRITE 
GO  TO 
WHITS 
GO  TO 
WHITE 
GC  TO 
WHITE 
GO  TO 
WHITE 


CEEN    LOCP    IN    WNORMI- 


29C 

(6  ,400) 
29C 

(6,410) 
290 

(6 ,420) 
29C 

(6,430) 
SAVE 

IF    (I? RITE    .GT.     1) 
DO   3  00    i=i,:js 
DC   300    j  =  i,ns 

WNORMI  (I  ,J)  =WNCFK  (I  . 

CALL    MINV     (NSC,WNCRMI,:iS  ,DDD,  D1,D2) 

CALL    RAP2NT     (H  S  ,  NS  ,  NS  ,6  ,  W  NO  RMI,4  ,  •  (6   (1X,  1PD13.  6)  )  ') 

BET'JRN 

CALL    MINV     (NSC.SNCEM  ,NS ,DDD,D1,D2) 

CALL    RAPfiNT     (  US  ,  IIS  ,  S  S,  6  ,  W  NO  RM  ,  4,  '  (6  (  1X  ,  1PD  1  3  .  6)  )   • ) 

RETURN 


U-INVERSE 
GC    TO     310 


}) 


320 

FORMAT 

330 

FCBMAT 

340 

FORMAT 

350 

FORMAT 

36  0 

FORMAT 

370 

FORMAT 

380 

FORMAT 

390 

FORMAT 

400 

FORMAT 

(//1X,42HOEEN    LOOP    2ISE1>VALUES D  ET  (  3  I- ?)  .  .  , // 

(//U,  46HC-LCOP    OPTIMAL    REG.      E-VALOES 3  ET  (  SI-  ?  +  G*  C) 

(//1X, 46HC-LOCP    S030PT.    BEG.     E-VALUES 0 ET ( SI- F+G*C) 

(//1X,46HC-LCCP    OPTIMAL    EST.     E-V8LO  ES.  .  .  DET  (SI-F*K*HJ 
//1X, 46HC-LOCP    SUBOPT.    EST.     E- V ALUE5 . . . 3 ET    SI- ?+ K* H) 

//1X,46HCEEN    LOOP    RIGHT    EIGENVECTOR    MATRIX T.. 

(//1X, 46BC-L0O?    RIGHT     EIGENVECTOR    MATRIX fl.. 

(//1X,46HCESN    LOO?    LEFT    EIGENVECTOR    I1ATRIX T-INV 

(//1X,  46BC-LCCP    OPT.     REG.     LEFT    S-VECTOR    MA IRI X. . M-I M V 


,//) 

,// 
.// 
,// 


99 


1*10 
420 
1*30 


FORMAT 
FORMAT 
FCSMAT 
1-,//) 


(//1X, 46HC-LOOP  SUEOPT-EEG.  LEFT  2-VECTOR  KATST X. . M-INV ,//) 
(//1X.46HC-LCCP  OPT.  FILTER  LEFT  E-VSCTOR  M  ATRIX.  .  .1  -  IN  V  ,//) 
(//U,5  1HC-LOC?    SUBOPT.    FILTER    LEFT    E-VSCTOR    MATRIX ..  H-IU  V. 


100 


SUE30U 

1      E 

IHFLIC 

DIM2NS 

,CC(U 

,D2  (N 

com? 

If  (IT 
I?  (IT 
CALL  ? 

C  — 

10 


ui. 
2i'' 

■-savE  i 


20 


30 


uo 

50 


60 


DO  20 
DC  20 
AA  (I, J 
DO  30 
DC  30 
CM  (I.J 
DC  36 
CM  (I,  J 
CALL  1 
DO  40 
DO  40 
EM  (I,  J 
DO  40 
EH  (I, J 
CCS TIN 
DO  50 
DO  60 
IP  (IT 

i.Eva.s 

IF  (IT 
COHTIN 

3ETUBN 
2ND 


TINE    TF     (fi,NK,NSQ.  A,AA,M,3,  BM  ,  L,C,CM , IFDFW.D ,  3B,CC,C  P, 

VR  ,EVI,PH,PI,SCfJCF,2BS  ,01 , J2 , DDD , EPS, IT F,  ITFX) 

IT    BEAL*eU-HfC-Z) 

10  H    A  (N  ,N)  ,  AA  (N.N)  ,  3  (  N  ,  £)  ,  3M  ( M  ,  M)  ,C  IL,  H)  ,  CH  (L,  N)  ,D  <L 

)  ,CE  (»)  ,  S7S  (N)  ,EVI  (N)  ,PB  |N)  ,?I  (tt)  ,3C  (MrN)  ,  JCF  (N)  ,BE5 

UTAIION    CN    CL     AND     CL    SYS    3ITH     MODAL    'rfORK    DONE    IN    OPT 

FX     .SQ.      1)     GO    TO    50 

FX    ,2Q.     2)     GO    TO    10 

CL£S     (N  ,  NH,  A,  AJ,M,  3,1,C  ,?R,?I,  D1 , D2  , JCF, SC) 

COMFGTE     MCCAi.     MATRICES     FOB     HESILUiJS 

1=1, N 
J=1  ,N 
)=SC(I,J) 
1=1,  L 
J=1,» 
) =C.D0 

k=i,m 

)  =cm  (i,  j)  +  c  |i,k)*aa  ik,  j) 

inv   (nsq,aa,n,  cdd,  d  1,d2) 

1=1, N 

j=i  ,a 

) =0.30 

K=1,N 

|  =Efl  (I,  J)  +  AA(I,K)  *B  (K,  J) 

1=1, M 

J  =  1,L 

J    .BE.     3)     CALL    ZEaOS     (  I  ,  J  ,  IFDF  «  ,  11  ,  NS  ,  A  ,  A  A  ,  M  ,  5  ,  L,  C  ,  D  , 

VI, D1  -D2  ,EPS) 

F    .BE.     2)     CALL    RES  ID     ( I  , J ,N , JC F , M ,3M , L ,C3 , P R , PI , 3ES , 

UE 


,M)  ,3B  <N 
(")  ,31  (N 

SYS 


EB,CC,CP 
3B,CC,  1) 


101 


10 


20 

30 


c— 

40 
50 
60 


susaocr 

IHELIC 

DI*FNS 
1CF(N)  . 
DC  10 
DO  10 
Aft (I, J 
CALL  a 
CALL  0 
CALL  0 
CALL  H 
IF  (IZ 
CALL    3 

sail" 

DC    20 
WHITS 

RETURN 

ians 

RETURN 


NE    POL 

HEAL* 

N    A  (  N  , 

T.N 


IS     (N, SM, A, AA,  2,c,L,C, EVB,£VI, 31 ,02,JCF,  FX) 

8  {h-H,C-L) 

H)  ,AA(N,SJ   ,3(NrK)  ,C(L,  S)  ,EVR(N)  ,£VI(N)  ,01  (N)   ,D2  (N)  ,J 


FCB3AT  (///.28H    TF    DENOMINATOR    EIGENVALUES:,/) 

FORMAT  {/.2X,3H        (  ,  ?  1  3.  6  ,  Ml)  *■  J  ( -  ?  13.  6  .  1  fl)  ) 

FCHrlAT  (35H    FAILURE     IH    dd'd2  ,     CALCULATING    POLES) 
2ND 


102 


10 


20 


30 


40 
50 


60 
70 
80 

C 

90 
100 
1  10 
120 

130 

140 


SCEEOUTINE  ZERCS  (K1  ,K2,  IFDFW,N,NM,A,AA,3,3,L,e,D,3a,CC,C:?,EVR,Z7I 
1r  D1,£2,EPS) 

IHPLICIT    REAL*8  (A-H ,C-Z) 

DIHEHSIOB  A(S,N)  ,  A  A  fN,S)  ,  3(N,M)  ,C(L,  N)  ,0  (Lr3)  ,33  (S)  ,CC  (H)  ,  CF(N)  ,  EV 
1R  (N)  ,271  (N)  ,D1  <M  ,D2  <  N) 

CCU3LE    PRECISION    SCL.DABS 

DC    10    1=1,3 

3S  (I)  =2  (I,K1) 

CC(I)  =  C(K2,I) 

DC    10    J=1,J 

AA  (I, J)  =A  (I,  J) 

5JRIT2     f 6  -  SOI      K1.K2 

IF     (IFDFH    .2Q.    0)     GO    TO     20 

H  =  D  (.<2  ,K1) 

IF     (DABS  (ri)  .  LE.  EPS)     GO    TO    20 

JJ  =  N 

GO    TO    50 

NN=N-1 

DC    30     1=1, NN 


H=SCL(N,E2, CC) 

CALL    CCOKP     (N , NM, AA,CC,CP) 

'")     GO    TO    40 


IF     (DA3S  (H)  .GT.22 
CCITIHOE 

:) 

B 


H  =  SCL (H.fiB.CC 
waiTE  Jo  ,  100) 
GO    TO    70 


JJ=H-I 

HRIT2      (6,110)      u*,H 

CALL    ACOMF     (N,NK,  AA,  E3,CC,H) 

CALL    3ALANC     IHt.S  ,  A  A, LOW  ,  IHI3E,D1) 

CALL    OBTEES     (  N  H  ,  N  ,LO  £  ,1  H  IGH  ,  A  A  ,  D2) 

CALL    30H      (N'M  ,N  .LCB.IHTGH,  AA,EVF,E7I,  IE3E) 

IF     (EER2    .HE.     5)     GO    TO    80 

flRITE      (6,120) 

DC    6  0     1=1.3 

SHITE     (6,130) 

SETUPS 

shite    (5,140) 

HETOBH 


E7R  (I)  ,271  (I) 


FOS.1AT 
FORMAT 
FORMAT 
FORMAT 
1  ALUES) 
FORMAT 
FORMAT 
END 


(///,  1 7  H    TF    FOR    INPUT    SO.,I3,,15H    AND    OUTPUT    NO.  ,13,  1H:) 
(//.5X.27HH0    FINITE    ZEICS.       TF    GAIN    =,E12.4) 
(/,3X, 20HCSDER   0?    NUMERATOR    »,I3,9X,9HT?    GAIN    =  ,S12.4) 
/,3X,57asoaESAIOR    EIGENVALUES     (INCLUDING    EXTRANEOUS    ZERO    7 


) 

(/*-*,     ..M,i. 

(52H    FAILURE 


4X,  1R(,E13.6,4H)+J(,F13.6,  1H)) 

'    IN    dQR    CALCULATING    TRANSFER 


FUNCTION    ZEROES) 
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c==- 


10 


SOEHOOTISE    iCOHP     (H,Sflrl,3. 

32AL*3     i.B-C-B 

DISEMSIOS    &(SB,H)  ,B(M),C{N) 

DO  10  1=1, N 
DC  ID  J=  I, a 
A  (I,Jl  =»  (I, J)  -a  (I)*C  |J)/H 

EZTTJ2N 
INC 


:,  t) 
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SUBROUTINE   CCCHP     (N , SH, A , C, CC) 
R2AL*B     A.C.CC 

DIH23SI0H    MSH,H)  ,C(N),CC(N) 
DO    10    1=1, N 

CC  (I)  =0. 
CO    10    J=1,N 


10 
20 


cc  d)=cc jfi  +  c  (j)  *-mj,d 

DO    20    1=1,8 


C(I)=CC(I) 

RSTU3N 
tfcE 
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FUNCTION    SCL     (N,2,C} 

HEiL*^     3,C,SCL 

DI32NSI0S    3 (M)  ,C  (N) 

5CL=0. 

DO    10    1  =  1, N 

SCI=SCL+C  <I)  *5  (I) 

aETuaN 

ESC 


10 
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10 

c— 


20 
C— 


30 


40 

50 
C— 


C  — 
60 


70 

80 


90 


SUBROUTINE    iSSID     (K1  ,K2  ,  H  ,JC?  ,fi,  B8,  L  , CH,PSf  PI,  3  ES  ,  BBrCC,  IPT) 

IMPLICIT     8EAL*9  |A-H,C-Z) 

DIMENSION    JC?  (N)  ,£M  (N,M)  ,CH(L,  8)  ,  PR  (  N)  ,  PI  (N)  ,RSS  (N)  ,33  (N)  ,CC  (N)  ,  F3 
1T  (4) 

DATA   SH/8H*SIN  (B*T/,B1/8H  */,  3  2/flHEXP  (A*T)  /  ,  ED/1  H)  / 

DAIA    Z£3C/0.D0/,T1/4H*T**/,  BLAK</3H                       /, CS/3 H*COS (3*T/ 
TEHPOBIBX    MOD    TILL    JCF    IS    CALCULATED 

DO    10    1  =  1, N 

JCF  (I)  =0 
TEMPORARY    MCE 

IF    (IPT    -SQ.     1)     SFITF,    (6,170) 

DO    20    1=1, N 

EE(I)  =  EH  (I.K1) 

CC  (I)  =CM  (K2,I) 
LOOP    THROUGH    IHE    POLES 

1=0 

1  =  1*1 

I?     (I     .31.    N)     GO    TO     160 

IF     (JCF  (I)     .EQ.     1)     GC   TO    60 

I?     (DABS  (PI  (if)     .LI.     1.D-101     GC    TO    50 
-".MFLE    COMPLEX    POLI 


-COMPUTE    SI! 


RESIDUES    AMD    PRINT    BOTH- 


0.D0)     PHT  (2)  =3IANK 


RES  (I)  =CC(I)  *BE(I)*CC(I*1)*BB  11+1) 

RES  (1*1)  =CC(I)*EE  (1+1)-  CC  (1+1  )  *B3  (I) 

IF     (IPT     .EQ.     0)     GC    TC    40 

PRT(1)  =BLANK 

PHT  (2)  =R2 

IF     <?I  (I)     -EQ, 

FET  (3)  =CS 

PRT(U)  =EC 

WRITE     (6,180)      ER  (I)  ,?I(I)  ,3ES  (I)  ,  (?RT(J)  ,J=1  ,4) 

I  =  t+1 

PHT(3)  =  SN 

iRITE     (6,130)      ER  (I)  ,  PI  (I)  ,RSS  (I)  ,  (PRT  (J)  ,J=1  ,4) 

GC    TO    30 

1  =  1+1 

GC    TO    30 

CONTINUE 
COMPUTE    SIMPLE    REAL    POLE    RESIDUE 

BBS  (II  =CC  (I)  *BE  (I) 

IF    (IPT    .EQ.     0)     GC    TO    30 

PRIM)  =31 

PHI  (2    =R2 

FHT  (3)  =8LANK 

PRT<4)  =BLANK 

IHITE     (6,130)     ER(I)  ,?I(I)  ,RES  (I)  ,  (PRT  (J)  ,J=1  ,4) 

GO    TO    3  0 
LOOK    ABEAC    TC    DETERMINE    SIZE    OF    THE    JORDAN    BLOCK 

K  =  1 

KT=N-I 

DO    70    J=I.KT 

IF     (JCF  (J)     .EQ.    0)     GC    TO     80 

K  =  K+1 

CONTINUE 

IF     (DA3S(FI(in     .IT.     1.D-10)     GC    TO    110 
COMPUTE    REPEATED    COMPLEX     PCLE    AND    PRINT    OUT    ALL    FOUR 

K=1 

HES(I)=CC(I)*EE(I)+CC(I+1)*BB<I+1)+CC(I  +  2)*33(I+2)+CC(I+3)*3B(I+3) 

RES  (1+  1)  =CC  (I)  *BB  (1+1)  -CC  (1+1)  *BB(I)   +CC(I  +  2)  *BB(I  +  3)-CC(I+3)*BB(I  + 
12) 

RES  (1+2)  =CC(I)  *BB  (I+3)+CC  (1+  1)  *BB  (1+  2) 

RES  (1+3)  =CC  (I)  *8B  |I  +  3)-CC  (1  +  1  )  *BB  (1+2) 

IF     (IPT     .EQ.     0)     GC    TO    100 

PRT  (1)  »S  1 

FHT(2)  =R2 

IF      DABS  (PR  (I))     .GT.     1.D-10)     GC    TO    90 

PRT  (1)  =ELANK 

PRT  (2)  =SLANK 

FHT  (3)  =CS 

PRT  (4)  =ED 

SHITE     (6,180)      FR  (I)  ,?I(I)   ,RES  (I)  ,  (PRT(J)  ,J=1  ,4) 

PRT  (3)  =SN 

1=1+1 

WRITE     (6.180)      PR  (I)  ,EI  (I)  ,RES  II)  ,  (PRT  (J)  ,  J=1  ,4) 

PET  (1)  =Tl 

PRT  (2)  =R2 


107 


100 
110 


120 
130 


140 

150 

160 

C  — - 
170 

180 
190 


I?     (DA3S(FR(I))     .LT.     1.  D- 10)     EET  (2)  *  BLANK 
PET  (3)  =C£ 
1=1+1 

WHITE     (6,190)     FR  (I)  ,EI  (I)  ,RSS  (I)  ,PRT  (1)  ,K,  (PHT  (J)  ,J  =  2,  4) 
PET  (3)  =»SS 
1  =  1+1 

URITE     (6,190)      FH  (I)  ,EI(I)  ,RES  |I)  ,PRT  (1)  ,X,  (PRT  (J)  ,J=2,") 
GC    TO    30 
1  =  1  +  3 
GC    TO    30 
•COMPUTE    REPEATED    REAL    POLS    RESIDUE    AND    PHINT    OUT    ALL    K    OF    THEM— 
CQHTINOE 
KT=I+K-1 

DO    130    J=I,KT 

NN=MN+  1 

RES  (J)  =  ZERO 

CC    120    JJ=J,KT 

RES  (J)  =RES  (J)  +EB  (J  J)  *CC  (JJ-NN  +  1) 

CONTINUE 

IP    (I?T    .EQ-     0)    GC    TC    150 

NN=0 

PRT(1)  =T1 

PET  (2)  =R2 

PHI  (3)  =QLANK 

F5T(4)  =eiA:iK 

DO    mo    J=I,XT 

WRITS     (6,190)      PR  (J)  ,FI(J)  ,RES  (J)  ,PRT  (1)  ,NN,  (PRT(  JJ)  ,JJ  =  2,4) 

NN=NN+ 1 

GC    TO    30 

I  =  KT 

GO    TO     30 

COt! TIM  UE 

RETURN 


FORMAT-    f//,3X, 22ERS3TDUSS    AT    TEE    POL SS: / , T 16 , 9H?    0 
1E    5    1    DUE    S./,T9.7HREA1  (A)  ,I26.7HIMAG  (3)  ) 

FORMAT      (/,4X,  lH(,5l3.6r4H)+J  (,f 1 3.6  ,  1H)  ,4X,1E(,F13. 

FORMAT      (/,4X  ,  1H  ( , F 1 3 . 6, 4H ) + J  ( ,2 1 3. 6  ,  1H)  ,  4X, 1H ( ,f 13. 
12A8.A1) 

ENC 


L    2    S,TU1 , 15HF 

6,  1H)  ,  3A8,  A1) 
6,1H)  ,A4  ,I2,2X, 
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SUERO'JTINE    3ALANC    (N«,M  ,  1  ,LOM  ,IGH,SC  ALE) 
INTEGER    I,J,K  ,L,3,N,  J  J,  N3,IGH  ,LCW,IEXC 
REAL*3     A(N3,N)  ,SCALE  (N) 
REAL*8    C.  F,G  ,R  ,S,E2, RADIX 

SEAL*3     DAE3 

LOGICAL    NCCONV 

DATA    RADIX/242  1COC0GC0OOOOO0/ 

32=aADIX*RADIX 

K=1 

L=N 

GO    TO    6  0 

C IN-LINE    PROCEDURE    FOR    ROW    ANC    COLU3N    EXCHANGE 

10  SCALE (3)= J 

I?     (J    .EC.    3)     GO    TO    40 

00    20    1=1, L 

F=A(I,J) 

A  (I, J}  =A  (1,3) 

A(I,3)  =F 
20  CONTINUE 

DC    30     I=K,N 

F  =  A  (J.I) 

A(J,I)=A  (3,1) 

A  (3,1)  =F 
30  CONTINUE 

40  GO    TO      (5C.90)  ,    TEXC 

C SEARCH    FCS    RO«iS    ISOLATING    AH     EIGENVALUE    AND    PUSH    THE3    TOWN 

50  IF     (L    .EC.    1)     GO    TO    230 

60  DO    80    JJ=1,L 

J=L+1-JJ 

DO    70    1=1, L 

IF    (I    .  EC    J)     GC    TO    70 

I?     (A  (J.I)     .HE.    O.GDC)    GO    TO    30 
70  CONTINUE 

H  =  L 

IEXC=1 

GO  TO  10 
80  CONTINUE 

GO    TO     100 

C SEARCH    FOR    CCLU3NS    ISOLATING    AN    EIGENVALUE    AND    PUSH    THE3    LEFT 

90  K=K*1 

100  DC    12C    J=K,L 

DO    110     I=K,L 

IF     (I    .EC.    J)      GC    TO     110 

IF     (A  (I.J)     .ME.    0.0D0)     GO    TO     120 
110         CONTINUE 

3=K 

IEXC=2 

GO  TO  10 
120  CONTINUE 
C NOW    BALANCE    THE    SUEKATRIX     IN    ROWS    K    TO    L 

DC    130     I=K,L 
130  SCALE (I) =1.0D0 

C ITERATIVE    LOOP    FOR    N0R3    REDUCTION 

140  NOCONV=. FALSE. 

DO    223     I=K,L 

C  =  0.0DO 

H=O.0DO 

DO    150    J=K,L 

IF    (J    .  EC-    I)     GO    TO     150 

C=C  +  DA3S  (A  (J,I)) 


fi=R+DAES  (A 


150 

CONTINUE 

I?     (C     -SQ. 
G=R/RA£IX 

F  =  1.0D0 

s=c+a 

160 

IF    (C     .GZ. 

F=F*2AEIX 

C=C*92 

GC   TO     160 

170 

G=R*3ADI X 

180 

IF     (C    .LT. 

GUAHE    AGAINST     ZERO    C    OR    R     DUE    TO    UNDERFLOW-- 
O.CDO    .CR.    R    .SQ.     0.000)     GO    TO    22  0 


I)     GO    10    170 


G)     GO    TO     190 
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F=f/3ACIX 

C=C/32 

gc  ro   180 

190 

IF    ({C    +    B)     /    F    .C-E.    0.95 
G-=1  .ODO/F 

SCALED  =SCALE  (I)  *F 

NGCOSV=. 1BOS. 

DC   200    j  =  k,:i 

230 

A  {I. J)  =4  (I, J)  *G 

DC    210    J  =  1,L 

210 
220 

A  (J, I)  =A  (J, I)  *F 

CCNTINOE 

I?     (MOCONV)     GC    TO    140 

230 

LCW  =  K 

IGH  =  L 

EETOHN 

END 

NOW     EALANCE-  — 
CO    *    S)     GO     TO 


220 
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SOEBOOTIHE  03TEES  (  N H , N , LOW , IGH, A ,03 T) 
INT2GS3  I .J, 8 , N,i:, J  J,  LA,  MP,  N !,IuH,KP1,  LOW 
REAL*8  A  <8tt,N)  ,C3T  (IGH) 

real*8   f.g,h,scaie 
real*8   dsc.rt,  ca£s,csign 
la  =  igh-i 

KP1=LOW  +  1 

IF     (LA     -L7.     K?1)     GO    TO    100 

DC    'JO     M=KE1,LA 

H=0.GDO 

CHT  (M)  =O.0DO 

SC  AL  T  =  G    CD  0 
c Z r__l SCALE    CCLUSN     (ALGOL    IOL   THEN    MOT    NEEDED) 

DO    10    I=H.IGH 
10  SCALZ=SCALZ+C  AES  (J  (I,.1-  1)  ) 

IF     (SCALE    .EQ.     C.CDO)    GO    TO    90 

3P=d+IGH 

DO    20    II=H,IGH 

I»HP-II 

03T(I)=A(1, 3-1)/ SCALE 

H=H*-OST  (l)*ORT  (I) 
20  CONTINUE 

G=-0SIGN  (CSQST  (H)  ,ORT(2)  ) 

H=H-03T (M)  *G 

OST  (2)  =OET  (H)  -G 


30 


UO 
50 
C— 


60 


70 
30 


90 
100 


-FORM     (I-(0*UT)  /H)     *    A 

DO    50    J=fl,N 

F=0.0D0 

DO    30    II=tt,IGH 

I=SP-II 

F  =  F  +  QRT(I)*\  (I  ,J) 

CONTINUE 

F=?/H 

DC    -0     1=8, IGH 

A  (I.J)  =A  (I, J)  -P*CET  (I) 

CCNTINUZ 

FCS(1     (I_  (U*rjT)  /H)  *A*  (I-  (U*OT)  /H) 

DC    90     1=1, IGH 

P=G.0D0 

DC    60    JJ=tt,IGH 

J=KP-JJ 

F=r+03T (J)*A (I, J) 

CONTIN  UE 

F=F/H 

DO    70    J  =  fl,IGH 

A  (I, J)  =A  (I,  J)  -F*OET  (J) 

CONTINUE 

OET  (.1)  =SCALZ*CET  («) 

A  (H,H-  1)  =£CALE*G 

CCNTTNUE 

RETU3N 

END 
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10 
20 


30 


uo 

C-- 

c— 


50 
60 
70 
80 


S0E3O0' 
INTEGEi 
3EAL*8 
3EAL*9 


I    OSTHAN     (NM,M,LC3 , TGH, A ,0R 1 , Z) 

,J, a ,  ki  ,ee,  ap,  n  a  ,igh  ,icw  ,ap  1 

Sa,IG5)  ,CBT  (IGH)  ,Z  (HK,S) 


DC    20 

DG     10 

2  (i,:) 

COSTIMi 

KL=IGH' 
I?     {KL 
DC    70 

mf=ig;i 

I?     (A( 

^c  1  =  1? 

DC    30 
OBI  (I) 

DC    50 
G=0.0D 
DC   40 
G=G+OR 


■INITIALIZE   Z    TO    IDENTITY     MATRIX- 


3  <"* 

si! 


3M  = 

-M 
HP 

♦  1 

1  = 

=  A 
J  = 
0 
1= 

T( 


CDO 
0D0 

B-1 

1.     1) 
1,KL 

!ap-i) 


GC    TO    80 

.EC.    0.0D0)     GO    10    70 


G=  (G    / 

DO    50 

Z  (I, J) 

COSTTS 

CONTIH 

3E1U3H 

END 


OF 


—  T     / 

-  L.     { 


an,  igh 
ji,hp-1) 

KE,IG3 

HB,IGH 
I)*Zll.J\ 

DIVISOo    SEL3S     IS     NEGATIVE    OF    H    FORMED    IN    OP.TH2S 

DOUBLE    DIVISION    AVOIDS    POSSIBLE    UNDERFLOW 

T  (HP)  )/A  HP, MP-  1) 

E,IGH 

I, J)  +G*OST  (I) 
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SOEHOOTIEI    HQ32     (  KM , N.LO i ,IGH  ,H, MR, W I , Z , I2R2) 

INTEGER    I,JtKrI,K,H,EH,II,JJf  I£raa,HArKBr3lNrIGH,ITS,LOW,aP2rSHa2fJ 
1  EBB 

REAL*S    H (NM,N)  ,  «  R  (N)  ,  WI  (  N)  ,  Z  (  N  «,  N) 

R£AL*8    P,Q,H,S,T,li.X,Y,Hi,SA,VI#VarZ2,N0Ba,aiCaEP 

REALMS     DSQIiT,  CAES,CSIGN 

INTEGER     MINO 

LOGICAL    NCTLAS 

COMPLEX     '16Z3 

COMPLEX     "M6DCMELX 

RHAT^rt     O  ^  E  ^  T.     nTvlAP 

C 5TAT£iz7lT    FUNCTIONS     ENABLE    EXTRACTION    OF    REAL    AND    IMAGINARY  — 

C PARIS    0?     DCUELE    PRECISION    COMPLEX     NUMBERS 

DREAL  (  Z3)  -Z3 

DIMAG  (Z3)  =  (0-0D0.-1.CD0)*Z3 

DATA    MACEIP/Z341CCC0COOO0CO0O/ 

IERR=0 

NCHM=0. JCO 

K=1 
C STORE    FOOTS     ISOLATED    3Y    3ALANC    AND    COMPUTE    MATRIX    NO  BM 

DC    20    1=1, N 

DC    10    J  =  K  , N 
10  NORM  =  N0R«>DABS  (H  (I,J)) 

K=I 

IF     (T     .GE.    LOtt     .AND.    I    .  LE.     IGH)     GO    TO    20 

WR(I)  =  H(I,I) 

HI  (I)  =C.  GDO 
20  CONTINUE 

EN=IGH 

T=0.ODO 

c SEARCH    ?05    NEXT    EIGENVALUES 

30  IE     (EN     .11.     LCVi)     GO    TO    290 

I1S=0 

NA=EN- 1 

ENM2=NA-1 

C LOCK    FOR    SINGLE    SMALL    SUB-DIAGONAL    ELEMENT 

HO  DO    50    LL=LOW,EN 

L=EN+LOH-LL 

IF     (L     .EC.    LOS)     GC    TC    60 

S=DABS  (H  (L-1,  L-1)  )  +CAB3  (H  (L,L)  ) 

if   (s   .eq.  o.occ)    s=soaa 

IF     (DABS  (H(L,  L-1)  )     .  LS.     MACBEP    *    5)      GO    TO    60 
50  CONTINUE 

C FORM    SHIFT 

60  X  =  H(SN,2N) 

IF     (L    .EC-    EN)     GO    TO    220 

Y  =  H  (NA  ,NA) 

H=H  (EM  ,  NA)  *H  (NA,  EN) 

IF     (L    .EC.    NA)     GO    TO    23  0 

IF     (ITS    .10.     30)     GO    TO    500 

IF      ITS     .HE.     10    .AND.    ITS    .HE.    20)     GC    TC    90 
C FCBM    EXCEPTIONAL    SHIFT 

T  =  T+X 

DC    70     1= LOW, EN 
70  H  (I.I)  =H  (1,1)  -X 

S  =  CA3S  (H  (EN,NA))  ♦  C  A  ES  (H  (  N  A,  EN  M  2)  ) 

X=0.75D0*S 

Y  =  X 
W=-0.4375DQ*S*S 

30  ITS=ITS*1 

C LOCK     FOR    T5C    CONSECUTIVE    StALL    SOB-DIAGONAL    ELEMENTS. 

DO    90     MM=L, ENM2 

H=ENM2+L-MM 

ZZ=H  (M,M) 

R  =  X-ZZ 

S=Y-ZZ 

P=(R    *    S    -    3)  /H(a*1,fl)  +  H  (H,M+1) 

q=h(m+  1,  a  +  1)  -zz-a-s 

R  =  H  (M+2.M  +  1) 

S  =  DABS  (P)  +  DA3S  (Q)  +CAES(R) 

P  =  P/S 

Q=C/S 

a=a/s 

IF     (M     .EC.    L)      GO    TO     100 

IF     (DA3S  (H(M,M-1)  )     *     (DABS(QJ     ♦    DABS(B))     .LE.     MAC3EP    *    DAB3(P) 
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90 
1C0 


110 

c— 


120 


150 
160 
C— ■ 


170 

180 
C— 


C  — ■ 
230 


1    *     (DA3S  (K(K- 1  ,M-1)  )     ♦    DA3S(22J     +    OA  ES  (H  (H+  1 ,  S  +  1 )  )  )  )     GO    TO     1( 

CONTINUE 
HP2=S+2 

DC    110     I=«P2,EN 
H  (1,1-2)  =C.0D0 
IF    (I    .2C-    MP2)     GC    TO    110 
H  (1,1-3)  =C.0D0 
CONTINUE 
DOU3LE    QR     STEP    INVOLVING     SCMS    L   TO    EN    AND    COLUMNS    M    TO    EN- 
DO    210     :<  =  :1,IU 
NCILAS-rC.NE.  HA 
I?    (K    .EC.    M)      GO    TO 
P=H  (K,  K-  1) 
Q=H  (K*  1,K-1) 

h=c.odo 

IE     (NOTLiS)     R=8(K+2,K-1) 
X=DA3  3  (P)+DA3S(C)+CAES(a) 
EC.    O.OtOj 
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TO     2  10 


IE    (X 
P=P/X 

c=c/x 

R  =  S/X 

S*CSISH (ESQBT  (P*P+Q*C+R*B),P) 
IF     (K     .SC-    3)     GO    TO     130 
-S*X 


3)      H  (K,K-  1)=-H  (K,  K-1) 


H  (K,K-1)  = 

GO    TO     1UC 

130 

I?     (L     .  N£ 

140 

P  =  P+S 

X=E/S 

Y=Q/S 

ZZ=a/3 

Q=U/P 

H=fi/P 

DC    160    J  =  K,N 

P  =  R (K, J)  +C*H  (K  +  1  ,J) 

IP     (.HCT.    NOT  LAS)     GO    TO     150 

P=P+P*H  (K+2. J) 

H (K+2, J)  =H(K+2,J)  -?*ZZ 

H  (K+1  ,  J)  =fl  (K+'1  ,J)  -P*Y 

H  <K,J)  =H  (K,J)  -P*X 

CONTINUE 

J  =  SIN0  (EN,K+3) 


—  BOW    MODIFICATION- 


DO    180    1=1, J 

P=X*H(I,K)  +  Y*B  (I,  K+1) 

I?     (.NOT.    NOTLAS)     GO    TO     170 

P=P+ZZ*H  (I, K  +  2) 

H  (I, K+2)  =H  (I,  K  +  2)  -P*S 

H  (I, K+1)  =H(I,K  +  1)  -?*Q 

BjI.KI  =  H  (I,K)  -E 

CONTINUE 

ACCUMULATE 

DO    200    I=LOW,IGH 

P=X*Z (I, K) +  Y*Z  (I, F+1) 

IP     (.NOT-    NOT13S)     GO    TO     190 

P=P+ZZ*Z  (I,K  +  2) 


■COLUMN     MODIFICATION- 


TRANSFORMATIONS- 


190  Z  (I,K+ 1)  =Z(I,  K- 

Z (I,K)  =Z  (I,K)  -F 

200  CONTINUE 

210         CONTINUE 
GO    TO    40 

c 

220 


-F*H 
■P*Q 


H  (EH. EN)  =X+T 

WB  (EN)  =H  (EN,  EN) 
31  (EM)  =0.GDO 
EN=NA 

GO    TO    30 


•ONE    RCCT    FOUND-- 


P=(Y    -     X)  /2.0DC 

Cj  =  P»P+W 

ZZ^DSQBT  (DABS  (CJ  ) 

H (EN, EN)  =X+T 

X  =  H  (EN  ,EN) 

H  (NA.MA)  =  Y+T 

IF     (Q     .LI.    0.0 DO)     GO    TO    2  70 


■T90    BOOTS    FOUND- 
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c aEUL   gaIB 

zz=p+dsigh<zz,ej 

HS  (N&)  =  X*ZZ 

B  B(EN)  =  8R  (NA) 

IP     (ZZ     .HE.     O.ODO)     HB  (EN)  =X-H/ZZ 

WI  (NA)  =O.0DO 

HI  (EN)  =C.CDO 

X=H  (EN,  MS) 

S  =  DA35  (X)  +DA3S  (ZZ) 

P=X/S 

Q=ZZ/5 

R=CSQRT (F*?+Q*Q) 

P  =  P/R 

C  =  C/R 
c i R0H    MODIFICATION 

DC   240    j=na,n 

ZZ=H (HA, J) 

H  (HA#J)=C*ZZ  +  P*B(IH,J) 

H  (EN,J)=Q»H(EN,J)  -F*2Z 
240          CONTINUE 
c COLOBN     HCDIFIC  ATION 

DO  250  1*1, EN 

ZZ  =  H  (I,NA) 

H  (I,NA)  =£*ZZ+P*H  (I, EN) 

H (I, EN)  =Q*H(I, EN) -P*ZZ 
250    CONTINUE 
c ACCUMULATE  TRANSFORMATIONS 

DC  260  I=LOW, 1GH 

ZZ=Z  (I  ,NA) 

Z  (I,NA)  *C*ZZ+E«Z  (I,£K) 

Z (I, EN) =Q*Z(I  ,EN)  -E*ZZ 
260    CONTINUE 

GC  TO  280 

c COMPLEX     £AIc 

270  Wfi(NA)=X+P 

HR  (EN)  =X*P 

HI  (NA)  =ZZ 

HI  (EN)  =-ZZ 
280  EN=ENS2 

GC    TO     30 

C ALL     FCCTS    FOUND.        E  ACKSUB  STITUTE    TO    ?IND- 

C VECTORS    0?    UPPER    TSIANGULAE    FORM 

290  IF     (NOR?!    .EQ.     0.0E0)     GO    TO    510 

DO    450    NN=1,N  i 

EN=N+1-NN 

P  =  HR  (EN) 

Q=WI  (EN) 

NA  =  EN-  1 

IF     (Q)     370,30C,45C 

c aEAL    VECTOR 

300  H=EN 

H  (EN.ZN)  =1.0D0 

IF     (NA    . EQ.     0)     GO    TO    450 

DO    360    11=1, NA 

I=EN-II 


H  =  H  (I,  I)  -P 

R=H(I.  EN) 

IF     (M     -GT.    NA)     GO    TO    320 

•jo  he 


R=H  (I,  EN) 

IF     (M     .GT 

DO    310    J  =  M,NA 
310  R  =  R  +  H  (I, J) *H  (J  ,ZN) 

320  IF     (HI (I)     .GE.     O.ODO)     GO    TO     330 

ZZ  =  H 

c  =  □ 

GO    TO    360 
330  (1=1 

I?     (HI  (I)     .NE.     C.CDO)    GO    TO    340 

T=H 

IF     (W     .EQ.    O.ODO)     T=BACHEF*NOEff 

H  (I,  EN)  =-R/T 

GO    TO     36C 

C SOLVE    REAL    EQUATIONS- 

340  X  =  H(I,I+1) 

T=H  (1+  1,  I) 

Q=(HR(I)      -    P)*(HR(I)     -    2)  >»I  (I)*WI(I) 

T=  (X    *    S    -    ZZ     *    A)/Q 

U  (I,EN)=T 
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IF     (DA3S  (X)      .LE.     EA3S(ZZ))     GO    TO    350 

H  fI*1,EH)  =  <-B    -    a    *    I)/X 

GC    TO    360 
350          H  (1*1,  EN)  =  (-5    -    Y    *    1)/ZZ 
360          CONTINUE 
c END    aEAL    vecTOH 

GO    TO    450 

c CO  3 FLEX    VECTOB 

37  0         1=  *r  A 

c _' LAST    VECTC2    C0.1PONE5T    CHOSEN    IBAGINABT    SO    THAT- 

c EIGINY5CTOB    SAIBIX    IS    TRIANGULAR 

IF     (DABS  (H  (EN,  HA)  )     .  LE.     DABS  (  H  <N  A, EN  )  )  )     GO    TO    380 

H  (NA,  NA)  =CyH(ENr  HA) 

H(NA.EN)  =-(H  (EN, EN)     -   ?)/H(EN,NA) 

GC    TO    390 
3  80  Z3=0C:iPLX  (0.3DO,-H(NA,EN)  )/DC!PLX  (H  (  NA,  NA)  -?,2) 

H  (NA.HA)  =CR2AL  (Z3) 

H  (NA,EN    =Di;iAG  <Z3) 
390         a    EN,NA)  =C.0DG 


H  (£N,  EN)  »1.0DG 

ENM2=NA- 1 

IF     (ENM2    .EQ.     0)     GO    TO    450 

DO    440    11=1, SN£2 

I=NA-II 

a=a  (i.i)  -B 
Bi*u.g  co 

SA=H  (I  ,SN) 

DO    4  00    J=M,MA 

3A=RA+H  (I.J)  *H  (J  ,b"A) 

SA=5A*H  (I, J)  *H  (J,  EN) 
400         CONTINUE 

IF     (WI(I)     .GE«     COCO)     GO    TO     41C 

ZZ=W 

fi=BA 

S  =  CA 

GO"?0    440 
410  1=1 

IF     («I(I)     .NE.     COCO)    GO    TO     420 

Z3=DC2ELX  (-RA,-SA)/DCMPLX  (H,Q) 

H  (I,  NA)  =CEEAL  (23) 

3  il.SN) sEIHAG  (23) 

GO    TO     440 

c SOL7E    COMPLEX    EQUATIONS 

420  X=H(I,I+1) 

Y=a  i+  1  ,i) 

7H=(WR(I)     -    ?)*(3F(I)    -    P)  *WI  (I)  *MI  (I)  -Q*Q 

71  =  (WB  (I)     -    ?)  *2.0DO*Q 

I?     (VR     .EC.     O.OCJ     .AND.     71    .EC-    0.0D0)     7R=  !1ACH  EP*NO  RJ1*  (DABS  (  S)     *    D 
1AES(Q)     ♦     LABS  (X)     +    CABS(Y)     ♦    CABS(ZZ)) 

Z3=DC.1PLX  <X*R-ZZ*BA*C.*SA,X*S-ZZ*SA-Q*RA)/DCaPLX  (7R,7I) 

H  (I,NA)  =C3EAL  (23) 

H jI,EN) =  CI!1AG  (Z3) 

IF     (DABS(X)      .LE.     CABS(ZZ)     ♦    DAES(Q))     GO    TC    430 

H  (1*1,  NA)  =  (-RA    -    I    *    9(1,  NA)      *Q    «H(I,EN))/X 

H  (I*1,SN[=(-SA    -    S    *    B(I,EN)      -    Q    *    H(I,NA))/X 

GC    TO    440 
430  Z3=DCSPLX  <-3-Y*H  (I  ,  N  A)  ,  -S  -Y*  H  (I,  EN)  )  /CCHPLX  (  ZZ  ,  Q) 

fl  (1*1,  NA)  =DREAL  (Z  1) 

H  (1*1,  EN)=DIMAG  (Z3) 
440  CONTINUE 

C END    COMPLEX    7  2CTOR 

450         CONTINUE 

c END    Eacx    SUBSTITUTION.    7ECT0RS    OF    ISOLATED    ROOTS 

DO    470     1=1, N 

IF     (I    .GE.    LOS     .AND.    I    .LE.     IGB)     GO     10    470 

DO    460    J=I,N 
460  Z  (I, J)  =a  (I,  J) 

470         CONTINUE 

c MULTIPLY     EY    TR  ANS  FCRH  ATIO  N    .1  ATS  IX    TO    GIVE 

c 7ECTCBS    OF   ORIGINAL    FULL    MATBIX. 

DO    490    JJ=LOW,N 

J  =  N*LOW-JJ 

H=3INO  (J ,IGH) 

DO    490    I=L3S,IGH 

ZZ  =  0.0  DO 

DO    480    K=LOW,a 
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480 
490 


C  — 

c  — • 

50C 

510 


ZZ=ZZ+Z  (I,K) 
Z  (I, J)  =ZZ 
CONTIN US 
GC  TO  510 


'H  (K,J) 


ie?s=e:j 

BETOHN 

EHD 


■SET    SBHOH    ~>NC    CONVERGENCE    TO     Ml- 
■EIGENVALUE   AFTEH    30    ITERATIONS 
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SUBROUTINE  3ALEAK  (  N  K,  N  ,  LOW  ,  IGE  ,  5CA  L  E  ,  B  ,  2) 

INTEGER  I,J,K  ,2,H,II  riia,IGH,  LCW 

SEAL*3  SCiLS(S)  ,Z  (N«€M)  ,S 

IF  (H  .EQ.  0)  GO  1G  60 

IF  (ISH  .EQ.  LCii)  GO  TO  30 

DO  20  I=LCHrIGH 

S=SCiLE(I) 

LEFT    HAND    BIGEKVECTCBS    ABE    EACK    T  E  kSS  FOB  .1  ED- 

1?    TFE    FOREGOING    STATEMENT    IS    REPLACED    31  —  ■ 

S=1  .OOC/ SCALE  (I)  . 


c— 
c— 

C-- 


10 
20 
30 


40 
50 
60 


:?    i   . 

IE    jl    . 

;=scals 


DC    10 
2  (I, J] 
CCNTIiJ 
DO    50 
1=11 

TV 

IE 
K 

I?  (K 
DC  UO 
S  =  Z(I, 
2(1,  J) 
2  <K,J) 
COHTIH 
CCNTIN 
S2TUHN 


J=  1,M 

=  2  (I, J)  *S 

DE 

11*1, H 


AND.  I  .  LE. 
I=LCW-II 


.GE.  LOS 
LT.  LOW) 

II) 
.EC.  I)   GO  TO  50 

j=i  ,a 
J) 

=  Z  <K,J) 
=  S 

OS 
UE 


IG5)  GO  TO  50 
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S0ESO0TIB1    HQR     (SH,H rLOH .ISHf E-3B,»I -IEBH) 

INTEGER    I,J,K,l-^,3,ZN,LL,aM,N4,aa,IGa,IXS,I.OW,a£l2#ENH2,IEaB 

REAL*8    H  (NMf  N)  ,is  (N)  ,«T  (N) 

HEAL*<3    P,C,fi,5,T,W,X,Y,  ZZ  ,:JO  R  C  ,  HACBE  P 

BEAL*8    DSCRT,EAESfDSIGH 

INTEGER    KINO 

LOGICAL    SCTLAS 

DATA    .1  ACfcEF/Z3U  1  0  COC  C000  0000  0  / 

IEUB=0 

NCBH=O.OEQ 

K=1 
C STORE    FOOTS    ISOLATED    BY    BAIANC    AND    COMPUTE    MATRIX    MC3M 

DO    2  0    1=1, N 

DC    10    J=  K    xr 
10  MORH=MOBH+D&BS  (H  {I, J)) 

I?     (I     .GE-    LOS     .AND.    I    .  LE.     IGH)     GO    TO    20 

WR(I)  =  H(I,I) 

ill  (I)  =0-  CDO 
20  CONTINUE 

EN=IGH 

T=0.0D0 

c SEARCH     FOB    NEXT    EIGENVALUES 

30  IF     (EN    .LT.     LOH)     GO    TO    250 

ITS=0 

NA=EN-1 

S  NM2  =  N  A-  1 

C : LOCK    EC5    SINGLE   SMALL    SUB -DIAGONAL    ELEMENT 

40  DO    50     LL=LOW,IN 

L=EN+LOW-LL 

IF     (L    .EC.    LOS)     GC    TC   60 

S  =  CABS  (H  (L-1.L-1)  )  *DABS  (H  (L  ,  L)  ) 

IF     (S     .EC-    O.OEG)     S=NORM 

IF     (DABS  (E(L,  L-1)  )     .  LS.     3ACHSF    *    S)      GO    TO    60 
50  CONTINUE 

c pq2B     SHIFT 

60  X  =  H(EN,EN) 

IF     (L    .  EC-    EM)     GO    TO    20  0 

Y  =  H  (NA  ,NA) 

S=H  (EN,  MA)*H  (NA,  EN) 

IF     (L    .EC.    NA)     GO    TO    210 
3f 
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IF     (ITS     .EO.     30)     GO    TO    240 

IF     (ITS     .HE.     1C     .AND.    ITS    .ME.    20)     GC    TO    30 
C EOaM     EXCEPTIONAL    SHIFT 

I»I*X 

DC    ^0    I=LC3,ZN 

H(I,I)  =H  (1,1)  -X 

S  =  CABS  (H  {IS,  SI))  +CAES(H  (NA,EN  K2)  ) 

X=C.75D0*S 
Y=X 

S=-0.4375D0*S*S 
30            ITS=ITS*1 
c LOOK    FOR    TWO    CCNSEC0TI7S    SMALL    SUB-DIAGONAL     ELEMENTS. 

DC    90    MM=L,SNM2 

n=ENM2+L-na 

ZZ  =  a  (M,M) 

R=X-ZZ 

S=Y-ZZ 

P=(R    *    S    -    fWfl(J!+1,fl)+H  (E,a+1) 

Q=H(M+  1,M  +  1)  -ZZ-S-S 

R=H (Mf 2.M+1 

S  =  DABS  (P)  *DABS  (C)  ♦CAES(S) 

P=P/S 

Q=C/S 

a=R/s 

IF    (M    .  EC.    L)     GO    TO     100 

IF     (DABS  (H(M,M-1)  )     *     (DA3S(Q)     ♦    DABS(R))     .LS.     MACHSP    *    DABS(P) 
1     *     (DABS  (H(M- 1,M-1)  )     +    DAES  (ZZ)     ♦    DA  ES  (H  (2H- 1  ,M  + 1 )  )  )  )     GO    TO     100 
90  CONTINUE  _ 

100         BP2=M+-2 

DO    110    I=MP2,EN 

B  (1,1-2)  =0.0D0 

IF     (I     .EC.    MP2)     GC    TC    110 

H  (1,1-3)  =0.0D0 
110         CONTINUE 
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C DOUBLE    S3    STEF    INVOLVING    ROWS    L    TO     EN     2ND    COLUMNS    3    TO    EH 

DC    190     K=8,NA 

NOTLAS=K.NE.NA 

If     (K    .EC.    H)     GO    TO     120 

P»H(K,K-1) 

C=S(K+  1f  K-1) 

r  =  c.odo 

IF     (NGTLAS)      a*E(K  +  2,K-1) 

S=DABS  (?)  +  DA3S  (C)  +DA£S(H) 
IF    (X    .  EC    0.  OCO)     GO    TO     190 
P  =  ?/X 
Q=C/X 

a  =  a/x 

120  S=CSI3N  (CSQRT  (P*P+C*C+H*B),P) 

IF     (K     .EC    3)     GO    10     130 

H  [K,K-  1)  =  -S*X 

GG    TO     lliC 
110  IF     (L     .HI.    3)      H(K,K- 1)=-H  (K,  K-1) 

^UQ         p=?+S 

X  =  E/S 

I»Q/S 

zz=r/s 
Q=0/? 
H=2/P 
c BCW    MODIFICATION 

DO    160    J=K,ZN 

P=H  (X,  J)  *Q*H  (K*1  ,J) 

IF     (.NCT.    -.(OIL  AS)     GO    TO     150 

P=P+R*H  (K*2, J) 

H(K  +  2,J)=H(K+2,J)-?*ZZ 
150  B  (5+1  ,  J)  =  fl(K  +  1  ,J)  -r*1 

H <K,J)  =H  (K,J)  -E*X 
16  0  CONTINUE 

J  =  KIN0  (EN  ,K+3) 
C COLUMN     .IOC  I?  I  CAT  ION 

DO    180    I=L,J 

P  =  X*H  (I,  K)  +Y*H  (I,  R+1) 

IF     (-NOT:    NOTLAS)     GC    TO     170 

P=E+ZZ*H  (I,K  +  2) 

H  (I,X+2)  =fl  (I  ,K+2)  -P*9 
170  H  \1,K*  1)  =9(1,  K  +  1)  -P*Q 

H  (!,:<)  =H  (I,K)  -E 
130  CONTINUE 

190  CONTINUE 

GO    TO    40 

C ONE    ROOT    FOUND 

200  WR  (EN)  =  X  +  T 

WI  (EN)  =O.0D0 

EN=NA 

GC    TO     30 

C TWC    ROCTS    FOU  ND 

210  P=  (Y    -    X)/2.0C0 

Q=P*?+  fl 

ZZ=DSQRT  (CABS  (Q)  ) 
X  =  X*T 

IF     (Q    .LT.    0.0E0)     GO    TO     220 
C REAL     EAIR 

ZZ=P+DSIGN(ZZ,E) 

WR  (NA)  =  X*ZZ 

WB  (EN)  =WE  (NA) 

IF     (ZZ     . NE.     0.0DO)     KB (EN) =X-W/ZZ 

WI  (NA)  =0.0D0 

WI  (EN)  =0.0D0 

GC    TO    230 

c COHPLEX    PAIR 

220  WR  (NA)  =  X*F 

WR  (EN)  =  X*E 

WI  (NA)  =ZZ 


WI  (EN)  =-ZZ 
230  EN=ENM2 


GO    TO    30 

C SET     ERROR    —     NO    CONVERGENCE    TO    AN- 

C EIGENVALUE    AFTER    30    ITERATIONS 

2U0  IEHR=2N 

250         RETURN 

END 
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c 
c 
c 

c 
c 
c 
c 

c 
c 
c 
c 
c 
c 
c 


SDBBOUTINE    PSCCAL    jK2,NS , FA ,X  ,SC,GH r GV    , C , NO , HY, HO , H, 

1  FBGE,NG,GAM,  3CL,i  ,  WR,  a  1, 0  1  ,  D2,JC?,  BBS  ,Q,  H,BB  ,CC  ,IYU  , 

2  IL55»£N0^i 

=      PSDCAL    C0MFC1ES    TKH    PSE    CP    OUTPUTS    CF    CONTROLS    OF 
A    CONTROLLED    SYSTE3 


IYU 


=    1 
=   2 

=    3 


OUTPUT    PSD 
CONTROL     PSD 

EOTH  OUTPUT 


AND    CON  1301    PSD 


IPSE=1 
=2 


INCBH= 


PS  D 

ESC    AND    TF    RESIDUES 


1,2,... 

SG+1,.  . 


NG        NORMALIZED    3  Y     ITH    PROCESS 
MG+K    NORMALIZED    3Y     ITH    KEAS 


NOISE 
NOISE 


10 

20 
30 

C  — ■ 


uo 

50 


c  — 

60 


70 
30 


DOUBLE    PRECISION    F A . X ,G W ,3V , C  ,KY , H , F  EGE , G AM , ACL, F, WE ,31, D 1 , £2 . BES, 
1 EE,CC,  Q,B,?SD,H,£H0BH,BS1  ,EMAX,ELOG,  SMGD,  D  W  ,  ST  ,OM  ,  K£ ,  A  I,  HO  ,  DH  1 


COMPLEX    *16ZD,ZN,ZZ 

DIMENSION    ?A  (  N  2  ,  N  2)  ,  X(N2,N2)  .  GW  (  N  2,  N  G)  ,  C  , 
1  ,?BG3(HS,S0)   ,  G  AM  (KS  ,  NG)  ,  ACL  (  N  S  ,  NS)  ,  F  (  NS  ,  NS)  .  WR  (  N"2) 
22(N2)  ,  RES  (N2)  ,  C  (NG.  NG)  ,R  ( MO  ,  NO )  ,  PSD  (  30)  ,  W  (30) 
3NC)  ,Hfl  (NC,N2)  , Cfl  1  (4) 

INTEGER    JCF(N2) 

DATA    D81/1.  DO,  2. DC, 5. DO,  10.00/ 

I?     (IYU     .EQ.     C)     IYU=1 


NC,NS)  ,  H  Y(NO,N2)   , 

«I{»2)  , 

33  (N2)  ,CC(N2 


H  t  N  C  .  N  S) 
D1  (N2)  ,D 
)  ,G7(N2, 


ZQ.     0)     I.NCEM=1 
IPT=1 


1) 


WRITE 
WRITE 


IF     (INOEM 
IPT  =  0 

IF     (IPSO    .GT. 
IX»IN0  3H-NG 

IF  (IX  .  GT.  0) 
IF  (IX  .LE.  0) 
NSQ=N2*N2 

COMPUTE    EIGENSYSTEH 

DC    10     1=1,  NS 

.do  10  j=i,ns 
fa  (i, j)  =  acl  (i,  j) 
fa  (ns+i,  j)  =  q.d0 

DC    30     I=1,NS 

DO    30    J=1,NS 

ST=0. 00 

DO    20     K=1,NO 

ST=ST*FBGZ(I,K)*H(K,J) 

FA  (I,NS+ J)=-ST 

FA(NS-H,NS+J)=F(I,J) -ST 

CALL    3  APR  NT     (N2,N2,N2,9 


(6,3  30) 
(6,3^0) 


IX 

IhCRM 


OF    CONTROLLED    SYSTEM;     FORM    FA- 


FA,  ft,  '  (9  (1X,  1PD13. 

— DEBUG    ABOVE 

(N2,N2,FA,LOW,IHIGH,D1) 


5)  )  ') 


I  ERR) 


CALL    3ALANC 

CALL 

CALL 

CALL 

IF     (ISRR    .!fE.     0) 

CALL   3ALBAK     (N2  ,  N2  ,  LOW, I HIG 3 . E  1 , N2, X ) 

CALL  3  APE  NT   N  2  ,  N  2  ,  N  2,  9  ,  X  ,  4  ,  r  (9  (  1  X,  1  PD  1  3  .  6)  )  • 

DEEUG  AECVEjDSTERMINE  2CDAL  MATRICES-- 

IF  (IYU  .£Q.  1)  GO  TO  60 

DO  50  1=1, NC 

DC  50  J=1,N2 

ST=0.00 

DC  40  K=1,NS 

ST  =  ST-C  (I,K)  *X  <F,J) 

HU  (I, J)  =ST 

GO  TO  90 
HSUBY 

DO  80  1=1, NO 

DC  30  J=  1,N2 

ST=O.DO 

HC  70  K  =  1  *J  S 

ST  =  ST+H  (l',K)  *X  (F,  J)-H  (I,  K)*X  (KS+K,J) 

HY  (I.J)  =ST 

CALL  R  APR  NT  (  NC  ,  NC  ,  N  2  ,9  ,  H  Y  .  4  ,  •  (9  ( 1X  ,  1  PD  1  3  .  6)  ) 
DEDUG  AEOVS 
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90 


CALL 
CALL 


MINV    (HSQ,X,K2,ST,  01  ,02) 
RAPRNT     (N2,N2,N2,9  ,X,4 


(9  (IX,  1  ED13.0)  )  ») 
ABOVE 


100 

no 


130 

mo 


150 


160 
c— • 


6e£ug 

GSUB  W 

DO    110     1=1, M2 

DC     110    J=1 ,NG 

ST=O.0DO 

DC    100    K=1,NS 

ST=ST-X  (I.fiS  +  K) *GAH (K,J) 

G  «  !  I  ,  J  )  =  S  T 

CALL    SAPENT     (32,  112,  NG,9  ,  GH.4 

DESUG    A3CVE;     USE    SELECTEE    NO  3H  A  LIZ  ATION 

INORH    .LE.     NG)     D NOR M= 1 .  DO /C  (INOR H , I  NO  EH) 


|9  (1X,  1PD13.  6)  )  «  ) 


IF 


ip     inorm 


(i::oRK-;iG,ii:cRa-NG) 

CF    CONTROLLED    SYSTEM- 


.  GT.     NG)     DNOEM  =  1.  DQ'/B 

C " DETERMINE    BA  ND5JIOTH 

EflAI=0. 00 
DO    120    I=1,N2 

EHQD»DAES  (8H  (11**2    ♦WI(I)**2) 
IF     (2.30D     .GT.     EMAX)      EHAX=EHOD 
120  CONTINUE 

2!JOD=OSQET(EMAX) 
SHOD=2*EaCD 

c SOUND    OP    TO    NEAREST 

SLOG=DLOG10 (EMOD) 

IF     (ELOG    .LT.     O.EC)      IPO  W=-IDI  NT  (D  AES  (ELOG) 
IF    JELOG     .GE.     0.D0)      IPO  »=  ID  I  NT  (ELOG) 
EMAX=EMOE*10**  J-IPOK) 
IF     (EMAX     .GT.     2. EC)      ZMOD  =  2.D0 

ZM0D  =  4.  DO 
EMOD  =  5.  DO 
EMOD  =  8.  00 
EMOD  =  10.  DO 


2,4,5,8,10- 
1) 


)) 


3    OSCACES    UP- 


IF     (EMAX    .GT.     4. DC) 

IE     (EH  AX     .GT.     5.  DC) 

IF     (EMAX    .GT.     8. DC) 

IF     (EMAX     .GE.      10. TO) 

EflAX=SMOD*10**IECS 

DW=EMAX/20.D0 
ADD    10     POINTS 

IF     (EMOD    .LT.     5. J)     GC    TO     130 

EMAX=1 .0D1 

IK=3 

GC    10     14 C 

EHAX=5  .DO 

IK  =  2 

CONTINUE 
STCP.S 

DC    150     1=1,20 

i  (I)  =oa*  1 1-1) 

DC    160     1=1,3 

IP=20*3*  (1-1) 

DO    160    J=1,3 

IX=MOD  (IK  +  J-  1  ,3)  +1 

JJ=0 

IF     (IK     .EC-    2     .AND.     J    .GE.    2)     JJ=  1 

1  (IP+J)  =  CW1  (IX)  *10**(IPOW+I-1  tJJ+IK-  2) 

CONTIN  UE 

IX=MOD  (IK, 3)  *1 

B  (30)=DI»1  (IX)  *10**  (IEOW+3    +IK-2) 

■LARGE    LOOP    THRU   OUTPUTS- 


3  0    FEEC.UENCIES- 


IF     (IYU    .2Q.     1)     SI=NC 

IF     (IYU     .  EQ.     2)     NL=NC 

DO    310    L=1,NL 

DC    170     1=1,30 
170         PSD  (I)  =0.00 
C LOOP 

DO    220    1=1, NG 

DN1=DNCBK*Q  (I,  I) 

IF     (IYU 

IF       IYU 

IF     (IYU 
1RES,33,CC,I?T) 

IF     (IYU.EC..2)      CALL 
IRES. 33 ,CC.I?T) 

DC    210     K=l,20 

ZZ=DCMPLX  (0.D0 ,0.D0) 

OH=W  (K) 

DO    200    11=1, N2 

IF     (WI  (II))     20C,  180,  190 
180  ZD=DCMPLX  (-WR  (II)  ,CM-WI  (II)  ) 


THRU    PROCESS    NOISE- 


.20.  1  .AND.  IPT  -EQ.  1)  WRITE  (6,350) 
•  EQ.  2  .AND.  IPT  .EQ.  -\l  3RITE  (6,360) 
EQ.  1)     CALL    RESID     (I  ,  L  ,N2  ,  JCF  ,  NG  ,G  VI ,  NL, 


I,L 
I,L 
HI,  HR  ,WI  , 

RES ID     (I,L  ,N2,JCF , NG ,G W , NL, HU , HR , HI , 
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190 


200 
21J 
220 
C 


230 

240 


250 
26C 

27  0 


280 
290 
300 


310 
320 


C  —  - 
330 
34  0 

3  50 

360 

370 

380 

390 
400 
U10 


ZZ=RES  (II)/ZD+ZZ 
GC   TO    20  0 
RE=WR (II) 

&I-VlilX) 

ZD=DCa?LX(RB**2    *    AI  **2    -    00**2.-2.  DO*fiI*OM) 

zn  =  dcmi>lx  jess  (ii>1)  «ai-res  (ii)  *re,r£s  (ii)  *om) 
zz=zz+zh/zd 

CCHTISOE 

PSD  (K)  =  ?SD  (K)  +  DN1  *  (ZZ*DCOMG  (ZZ)  ) 

CONTINUE 
--GSUBV 

DO    240     1=1, N2 

DO    240    J=1,NO 

ST=0. DO 

DO    230    K=1,HS 

ST=S~*X  (I,K)  *FEGE  (K,J)  +X  (I,NS*K)  *F5GE  (K,J) 

GV  (I, J)  -SI 

CALL    BAPBHT     (  N  2  ,  N2,  MO,  9  ,  G  V,  4  ,  •  (9  (  1 a,  1?D  1  3.  6)  )  »  ) 
DEBUG    ABOVE,     LOO?    THBO    MEAS    NOISE— 

DO    300     1=1, NO 

DN1=DNCRM*3 (I  .1) 

IF     (ITU     .  EQ.      1     .AND.    IPT 

IF     (ITU    .EQ.     2     .AND.    IPT 

IF     (ITU. EC.  1)      CiLL    P.ESID 
1  3B.CCIPT) 

IF     (ITU.ZQ.2)     CALL    RESID 
1  BB,CC,IPT) 

DO    290    K=1.30 

zz=dc:*.?lx  (5.  cc, a. 10) 

OK  =  W'(K) 

DC    270     11=1, N2 

IF     (WI(II))     27C.25C.260 

zu*DcaPLX  (-Ms  (ii)  ,o«-wi  (id  ) 

ZZ=ZZ+RES  (II)  /ZD 

GC    TO    270 

BE  =  WR (II) 

AI=WI(II) 

ZD  =  DCMPLX  (RZ**2    ♦    AI**2     -CM  **2  ,  -2  .  DO  *  RE  *OM) 

ZN=DCMFLX  (RES  (II+1)  *  AI-RES  (II)  *SE,P.2S  (II)  *GM) 

ZZ*ZZ+ZN/ZD 

CONTINUE 

IF     (ITU     .EQ.     2    .CH.    I    .  NE.     L)     GO    TO 

PSC  (K)  =  PSC(K)  >£N1 

PSD  iK)  -PSD(K)  +  DB1*(ZZ*DCOHJG  (ZZ) ) 

CONTINUE 


.EQ.  1} 
.EQ.  1j 
(I,L,N2, 


WRITE     (6,37  0)     I,L 
WRITE     (6,380)     I,L 

jc?  ,  nc,gv,;;l,:iy,  wa,w: 


(I  , L,N2, JCF  ,  NO,GV,NL, HU, WR,WI,?2S, 


280 


CONTINUE 


IF  (ITU  .EQ.  1)  WRITE 
IF  jITU  .EQ.  2)  WRITE 
WHITE     (6  ,410)       (H  (I)  ,  PS 


CONTINUE 
RETURN 
CONTINUE 
CALL    2REXIT 
RETURN 


6,390)  L 
6,40  0)  L 
(I), 1=1, 30) 


(N2,  EA,IERR) 


FORMAT     (/,41H     SUBSEQUENT     PSD    IS    NORMALIZED    3T    MEAS    NO., 13) 
POSMAT     (/.50H    SUBSEQUENT     ?SD    IS    NORMALIZED    bt    PROCESS    NOIS1 


H 


NO. ,13 

,13H    ME 

FORMAT^j/38H'iBANSFER   FUNCTION    FROM    PROCESS    NOISE    ,I2,3H    TO,9H    CCN 

MEASURE 
CONTROL 

FHEQ,, 
D    FREC, 


CBBAT     (/38H    TRANSFER    FUNCTION    FRCM     PROCESS    NOISE    ,12, 3H    TO 
1ASUSEMENT    ,12) 

r    W 

1 T  RC  L       l2 ) 

FORMAT     (/36H    TRANSFER   FUNCTION    FROM     MEASUREMENT    ,12,168    TO 
1MENT    ,12) 

FORMAT     (/36H    TRANSFER    FUNCTION    FROM     MEASUREMENT    ,I2,12H   TO 
1     ,12) 

FORMAT     (/14H     PSD    CF    CUT? UT, 13  ,32H       FCRCED    BT     ALL    NOISE-(3AD 
1  15HNOHMALIZ2D    ESC)/) 

FORMAT     (/15K    PSD    CF    CCNT HCL , I  2 , 32H       FORCED    BT    ALL    NOISE- (3A 
1 .  15HNORMALIZEE    PSD)/) 

FOBMAT     (4(1X,1B(,E11.4,1H,,E11.4,1H)  )) 

END 
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0==  =  ==  =  ====  =  =  =  =  =  =  =  =  =  =  =  =  ====  =  =  ==  =  =  ==  =  =  =  ==  ==  =  =  =  =  =  ========  =  ==: 

SDE3CUTINE    EREXIT     (tl,A,IERR) 
C  EREXIT    RETURNS    THE    NUMBER    OF    THE    EIGENVALUE    WHERE    HQR2 

C  PAILS,     THEN    STOPS    THE    PROGRAM. 

C==  =  ========  =  ==  =  ===  =  =  =  ==========  =  ==================  =  ==  =  =  =  ==  ■ 

INTEGEH     IERR 
DOUBLE    PRECISION    A 
DIBENSIGK    A(N,N) 
U fi  I TE     (5     \Q\     I  £ B  K 

CALL"RAPElif     (NrH,N,9rA,  4,  '  (9(  IX,  1PD1  3.6)  )  •) 
R  E I U  F  *1 
10  FCS3AT      (35H    FAILURE    IN    HQR2    ON    EIGENVALUE    NO.     ,13) 

END 
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c 


10 
20 

c— 

30 
40 


50 

60 
70 

80 


SUEBOOTIKI    REACE     (NS,ISAF,3A) 

IHTEB&CTIVELY    ENTERS    THE     "F"     « AT  RXX     EL2MENT_B7_ 

R2AL*3       EA  (NS  ,NS)  ,DUff,ANSS 

INTEGER     I,J,X,L.  IJSNS.ISAF 

DATA    n/'Y'/.rZ/'KV 

I?     (15  AE.  £0.  1)     GO    TO    40 

WRITS     f5  -  130) 

CO    2  0    1*1 ,NS 

DC    10    J=1,MS 

WRITS      (5.120)      I, J 

CALL    RDREAL     (ANS2) 

BA  (I, J)  =  ANSR 

CONTINUE 

CONTINUE 


iLSHENl 


90 
100 

110 


C 

120 
130 

140 
150 

160 
170 
180 


CALL    FRTCMS     ('CLRSCSN    ') 

CONTINUE 

SRITE      (5,140) 

CALL    LATEST     (EA,NS,NS) 

WRITE      (5.150) 

CALL    HDCEAR     (  IANS) 

IF     (  (IANS. NE. IK)  -AND.  (IiSS. 


GC    TO 


70 

!8 


KE.IZ)  )     GC    TC    60 


WRITE     (5,160) 
5T 


l¥. 


GC 
GC 


GC    TO 

CONTINUE 

I?     (IANS.EO 

IF    JI4HS-2Q.I 

WRITS     (5,170) 

CALL    ?.DINT     (TANS) 

K=IANS 

WRITE     (5,180) 

CALL    2DINT     (IANS) 

L=IANS 

WRITS     (5,120)     K,L 

CALL    3DHEAL     (ANSR) 

DUM=ANSR 

DO    100    I*1,HS 

DO    90    J=1,fiS 

IF    J(I.SQ.K) 

CONTINUE 

CONTINUE 

GC    TO    30 

CONTINUE 

CALL    FRTCMS 

RETURN 


TO 
TC 


1  10 

30 


AND.  (J.EQ.  L)  )     3AlI,J)  =  DUM 


(•CLHSCRN    ') 


FORMAT 
FORMAT 

1ENSION 
FORMAT 
FORMAT 

1ENT?,// 
FORMAT 
FORMAT 
FORMAT 

END 


,  10X 
1X, 
5X, 
5X, 


14HTHE 
X,  36F.E 
STATES 
15X, 33 
1.5490 
,  19ETY 
51 HWAR 
5  0HENT 
53HEN1 


SLSME 
BTES  T 

NS 
HTHE  S 
C  YCU 
FE  "YS 
NING: 
ER  THE 
ER  THE 


F  (,I2,1H,,  12, 2H) =) 

SYSTEM    MATRIX       ''F-'-MATEIX 


,//,  10X,  41HDIM 


NT 

HE    SYSTEM 

X     *    STATES       NS    ) 

YST2M     fATSIX        "F"-MATRIX 

WISH    TC    CHANGE    TBE    VALUE    OF    ANY'  MATRIX    ELEM 

S"    OR     "NO".) 

IMPROPER    DATA     ENTRY!        ENTER    "YES"    OR    "NO".) 
RCW     NUMBER    OF    THE     ELEMENT    TO     BE    CHANGED.) 
CCLUMN    NUMBER    OF    THE    ELEMENT    TO    3E    CHANGED 
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C  =  =  ====  =  ====  =  =  =====  =  =  =  ======  =  ===  =  =  =================  =  =  ===  =  =  =  £»:  =  ====  =  = 

SUBROUTINE    RE3CH      (NO  ,NS  ,  I  3AR  ,  HC) 
C  INTERACTIVELY     ENTERS    THE     "H"     MATRIX       BEASU8EHBNT    SCALING    3ATRIJC     . 

C  ======  =====  =  ======  =  =  =  =======  =  ==========  ====================  =  =  ====  =  = 

HEAL*3       ECfMQ.NS)  ,DDH,ANS3 

INTEGER     IANS,  I  ,  J  ,  :<  ,  L  ,  ISAH 

DATA    IY/"Y'/,IZ/f N»/ 
c 

C       TEIS    IS    All    EXAMFLE    C?    ONE    POSSIBLE    METHOD    OF    ARRAY    GENERATION 

C       WITHIN    THE    PROGRAM    ITSELF.        FOR    VERY    LARGE    DATA    ARRAY?,    THIS     METHOD 

C       MAY     £•£    PREFERABLE    TO    SOME    US  ESS    OVER    INTERACTIVE    ENTRY    0?    EACH 

C       INDIVIDUAL    EISMENT. 

c 

C  DO    2    1  =  1  ,11 

C  DO     1    J=  1,3  2 

C  HC(I,J)  O.OD  +  00 

C  BC(1,  1[  =    0.1  15200  + CO 

C  HO(2,75)  =    0. 57300*02 

C  EC(3,74)  =     C.  10000*01 

C  HC(U,63)  =    3.5730D  +  02 

c  ac  (5, 62       =   o.  ioooa  +  0  1 

C  HO(6,76)  =    0.573JD  +  02 

C  KC(7,u4  =    C.573CD*02 

C  HC(8,45)  =    0-5730DO2 

C  HC    9,46)  =    0.573GD  +  02 

C  HO    1G(i*7)  =    Q.5730D  +  02 

C  EC(11,u8)  =    3.57300*02 

C1  CONTINOE 

C2  CONTINOE 

C  GO    TO    90 

C3  CONTINUE 

c 

IF     (ISAH.  EQ.  1)     GO    TO    40 

WHITE     (5.12  0) 

DC    20    1=1, NO 

DO    10    J=1  eNS 

WRITS     (5,110)      I, J 

CALL    RDREAL     (ANSH) 

HC  (I,  J)  =ANSR 
10            CONTINUE 
20            CONTINUE 
c 

30  CALL    PRICES     ('CLRSCEN    ») 

40  CONTINUE  ' 

WHITE     (5,130) 

CALL    H&TPET     (HC,NC,NS) 
50  WHITE     (5,140) 

CALL    RDCHAR     (IANS) 

IF     ((I  ANS.NE.  IY)  .AND.  (IANS.NE.IZ)  )     GO    TO    60 

GO    TO    70 
60  WHITS     (5,150) 

GO    TO    50 
70  CONTINUE 

IF     (IANS.EQ.IZ)     GC    TC    100 

WHITE     (5,1fa0) 

CALL    RDINI     (IANS) 

K=IANS 

WRITS     (5,170) 

CALL    RDINT     (IANS) 

L=IANS 

SHITE     (5,110)      K,L 

CALL    RDREAL     (ANSR) 

DUH=ANSR 

DO    90    1  =  1, NO 

DC    30    J=1,SS 

IF     (  (I  .EC..K)  .  AND.  (J.  EQ.  L)  )     HO(I,J)=DUM 
80  CONTINUE 

90  CONTINUE 

GC    TO    30 
100  CONTINUE  - 

CALL    FHTCMS     ('CLRSCRN    ') 

RETURN 
c 

110  FORMAT     (5X.14HTHE    ELEMENT    H  (  ,  12  , 1  H  ,  ,  12  ,  2H)  =) 

120  FORMAT      (/ , dX , 5 C RENT ER    THE    MEASUREMENT    SCALING    MATRIX       "H"-MATRIX 

1,//,1 JX,47HDIMENSICN    =    *    OBSERVATIONS       NO       X    *    STATES       NS    ) 
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•'  tj"—  *J  ATR  T  X 

ANY    HAT2IX 


ELZM 


133  FORMAT  {//,  13X,4bcTHE   MEASUREMENT    SCALING    MATRIX 

1/) 

140  FOHHAT  (//5Z.5UHCC    YCO    SISH    TG    CHANGE    THE    VALOE    OF 

1ENT?,//, 10X.1 9HTYEE     "YES"    OR     "KG".) 

153  FORMAT  (  1X ,  5  1  HH  ARNING :     IMPROPER    DATA     ENTRY!        ENTER    "YES"    OR    "NO".) 

160  FORMAT  (5X,5GHENIER    THE     3CW     NG2BER    OF    THE    ELEMENT    TO    3E    C'JANGED.) 

170  FOaaAr  (5X,52HENTEP.    THE    CCL'JMN    NUM3E5    0?    THE     ELEMENT    TO    2E    CHANGED 

END 
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C== ========================================================= ============ 

SUBROUTINE    REACD     |KC,NC,D) 
C  ENTERS    THE    "C"    MATRIX       .•MEASUREMENT    FESD-FOHWARD    DIST.     HATHIX    . 

C==  =  =  =  =  ===========  =  =  =  =  =  =  =  ===  =  =  ==  =  =============  =  =========  =  ==  =====  ======= 

BEAL*4        C  (NO,  NC)  ,EUM,ANS  3 

INTEGER     I&NS,I.J,K,L 

DATA    IY/' YV,  12/' N'/ 

WRITS     (5,110) 

DO    20    1=  1  ,'10 

DC    10    J=1,NC 

WRITS     (5,100)      I, J 

CALL    RDREAL     (ANSR) 

D  (I.J]  =  ANSR 
10             CONTINUE 
20            CONTINUE 
c 

30  CALL    F3TCSS     ('CLRSCRN    •) 

WHITS     (5,120) 

CALL    MATPHT     (D  ,NC,NC) 
40  WRITS     (5,130) 

CALL    RDCHAR     (IANS) 

IP     (  (I  ANS.NE.I 1)  -AND.  (IANS.  US.  12)  )     GO    TO    50 

GC   TO    60 
50  WRITS     (5,1^0) 

GO    TO    40 
60  CONTINUE 

IF     (IANS.EQ. 12)     GC    TC    90 

WEITS     (5,150) 

CALL    3DINT     (IANS) 

K=IANS 

WRITE     (5,16  0) 

CALL    7.DINT    (IANS) 

L=IANS 

WRITS     (5,100)      K,L 

CALL    3D3EAL     (ANS5) 

DUM=ANSR 

DC    80     1=  1,NO 

DO    70    J=1,NC 

IF     (  (I.  SC..K)  .  AND.  (J.  EQ.L)  )     D(I,J)=DUM 
70  CONTINUE 

80  CONTINUE 

GO    TO    3  0 
90  CONTINUE 

CALL    FRTCMS     ("CLRSCEN    ') 

3ETU3N 

C 

100  FORMAT     (5X.14ETEE    ELEMENT    D  (  .  12  ,  1  H  ,  ,  12  ,  2H)  =) 

110  FORMAT     1/,5X,54HENTE3   THE    MEASUREMENT    FESDTHROUGH    MATRIX    /     FEEDFOR 

1WA3D,/,5X,34ri    DISTRIBUTION    MATRIX       "D"-MATRIX    .  ,  //,  8  X,  49  HDI3ENS  ION 
2    =    *    OBSEHVATICSS       NC       X     4    CONTROLS        NC    ) 
120  FOStfAT     (//,5X,5CHTHE    FEEDFORWARD    DISTRIBUTION    MATRIX       "D"-MATRIX    . 

1..//) 

130  FORMAT     (//5X,54BCC    YCU    WISH    TO    CHANGE    THE    VALUE    OF    ANT    MATRIX    ELEM 

1ENT?,//, 1CX. 1 9HTYEE    "YES"    OR    "NO".) 
140  FORMAT     (  1X,D  1  HWA3NING:     IMPROPER    DATA    ENTRY!       ENTER    "YES"    OR    "NO".) 

150  FORMAT     (5X,5GHENTEB    THE     RCW     NU2BE3    OF    TRE    ELEMENT    TO    3E    CHANGED.) 

160  FC3MAT     (5X,53HENTER    THE    COLUMN    NUM3ES    OF    THE    ELEMENT    TO    BE    CHANGED 

1.) 
END 
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c 
c== 


SUBfiOUTlKE    HE. 

INTERACTIVELY 


EG 

ENT 


(NS/.IC,  ISAG 
I B  £    TH  i     "G  " 


G) 

2ATRIX       CONTROL    DISTRIBUTION     MATRIX    = 


10 
23 
C  — 
30 
40 


50 

60 
70 


EEAL*8        G  (NS  ,  NC)  ,£0a,ANSR 
INTEGER     IANS,I ,d  ,K.L,ISAG 
DATA    H/'YV,  IZ/'  Sr/ 
IF     (ISAG.EQ.  1)     GC    TO    40 
SHITE     (5  ,  120) 

do  20   r=  1  ,:is 

DO    10    J=1,NC 
WHITE     (5,110)      I, J 
CALL    RDREAL     (ANSR) 
G  (I, J)  =  ANSB 

CONTIN US 
CONTINUE 


80 
90 

100 


c 

110 
120 

130 

140 

150 
160 
170 


CALL    FRTCSS     ('CLESCRN    •) 
CONTINUE 

WRITE     (5,130) 

CALL    .1ATFBT     (G,NS,NC) 

'WHITE     (5,140) 

CALL    3  DC HAH     (IANSJ 

IF     (  (IANS.NS.  IY)  .  ISO.  (IANS.  HE.IZ)  )     GO    TC    60 

GO    TO    70 

WRITE     (5,150) 

GO    TO    50 

CONTINUE 

IF     (IANS.EQ.IZ)     GC    TC    100 

WRITE     (5,16  0) 

CALL    RDINT     (IANS) 

K=IAN3 

■  RITE     (5.170) 

CALL    HDIKT     (TANS) 

L=IANS 

WHITE     (5,110)      K,L 

CALL    RDREAL     (ASSS) 

DU.".=  ANSR 

DO    30    1=1, MS 

DC    80    J=1,ZiC 

IF     (  (I  .SQ.KJ  .AND-  (J.EQ.  L)  )    G(I,J)=DUfl 

CONTINUE 

CONTINUE 

GC    TO    30 

CONTINUE 

CALL    FSTC2S     ('CLRSCBN    ') 

RETURN 


FORHAT 

FORHAT 

1.,//,1 

FoaaAT 
1//) 

FCPHAT 
1ENT?,/ 
FGEMAT 
FOR3AI 
FORMA! 

END 


(5X.14HTHE    ELEMENT    G  (  ,  12  ,  1  H  ,  ,  12  ,  2H)  =) 

(/,5X,  5  1HENTEH   THE    CONTROL    DISTRIBUTION    .MATRIX       BG"-flAIBIX 
0X.43HDIKESSICN    =     #    STATES       NS       X    *    CONTROLS       NC    ) 
(//,10X,47HTHE   CONTROL    CISTRIEUTICN    MATRIX       "G"-MATRIX    .... 

(//5X.54HCC    ICO    WISH    TC    CHANGE    THE    VALUE    OF    ANY    MATRIX    ELEM 
/, 1CX. 1 9HTYEE    "YES"    OR     "NC".) 
( 1X,5 1 HWARNIMG:     IKFROPER    DATA     ENTRY!       ENTER    "YES"    OR    "NO".) 

5X,50HENTER    THE     RCW     NUMBER    OF    THE    ELEMENT    TO    3E   CHANGED.) 
(5X.53HENTER    THE    COLOHN    NUMBER    OF    THE    ELEMENT    TO    BE    CHANGED 
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10 
20 
C- 

30 


SUBROUTINE    READE3     {  NC,NS  ,  FBGC) 

EHIERS    THE    "C"    MATRIX  FEEDBACK    GAIN    CONTROL    MATRIX 

REAL*3        FlGC (NC,NS) , CUM , ANSR 

INTEGER    IANS,I,J.K.L 

DATA    IT/'Y' /,  IZ/f h' / 

WRITE     (5,110) 

DC    20    1=1,  ac 

DC    10    J=1,:iS 

WRITS     (5,10  0)     I,  J 

CALL    RDREAL     (ANSR) 

FBGCJI ,J) =  ANSK 

CONTINUE 

CONTINUE 


40 

50 
60 


70 
80 

90 


C— - 

100 

110 

120 

130 

140 
150 

160 


CALL    FRTCMS     ('CIBSCEN    •) 

WRITE     (5,120) 

CALL    MATP5T     (FEGC,NC,NS) 

WRITE     (5,130) 

CALL    RDCHAR     (IANS) 

IF     ((IAHS.NE.lt)  .AND.  (IANS-  HE.IZ)  ) 

GC    TO    60 

WRITE     (5,140) 

GC    TO    40 

CONTINUE 

IF     (IANS. EQ. 12)     GC    TC    90 

WRITS     (5,150) 

CALL    RDINT     (IANS) 

X=IANS 

WHITS     (5,160) 

CALL    3DINT     (IANS) 

L=IANS 

WRITE     (5,100) 

CALL    RDREAL     I 

DU3=ANSR 

DC    30    1=1,  NC 

DO    70    J=1,NS 

IF     ({I.  EC.K)  . 

CONTINUE 

CONTINUE 

GO    TO    30 

CONTINUE 

CALL    PETCMS     ('CLRSCRN    «) 

RETURN 


GC    TC    50 


8,1 

ANS2) 


AND.  (J.  EQ.L)  )     F3GC  (I, J)  =DUM 


FCBMAT 
FORMAT 

1     -,//,  1 
FORMAT 

D 
FORMAT 

1ENT?.// 
FORMAT 
FORMAT 
FORMAT 

1  . 
E 


"C"-MATRIX 
S    .) 
"C "-MATRIX    ,// 


EN! 


(5X.14HTEE    ELEMENT    C  (  ,  12  ,  1H,  ,  12,  2H)  =) 

/,oX,52HSNTEH  THE  FEECEACK  GAIN  CONTROL  MATRIX 
OX, 44  HDIMEKSICN  =  *  CONTROLS  NC  X  *  STATES  N 
(//,10X,45HTHE    FEEDBACK    GAIN    CONTROL    MATRIX       "C 

(//5X,54HDC    YCU    WISH    TC    CHANGS    THE     VALUE    OF    ANY    MATRIX    HLZM 
1CX    19HIYEE    "YES"    OR     "NC".) 

\ 1X,5 1HWASNING:     IMPROPER    DATA     ENTRY!       ENTER    "YES"    OR    "NO".) 
5X,50HENTER    THE     R CW    NU2BER    OF    TBE    ELEMENT    TO    BE    CHANGED.) 
5X,5  3H£NTER    THE    COLUMN    NUMBER    OF    THE    ELEMENT    TO    BE    CHANGED 
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c 
c== 


SUBROUTINE    RSACAY     (NC,AY) 
ENTERS    THE    "A"     BAIHIX         DIAG 


ORAL    OUT  EOT    COST    SATS  IX 


10 
20 
C  — 
3C 


uo 

50 
60 


BEAL*8        AY(NO  ,  NC)  ,DUM,AN 

INTEG2?    IASS,I  ,J,  ?,L 

DATA    IY/« Y'/, IZ/'N'/ 

HRITE     (5.110) 

DC    20     1=1,30 

DC     10    J=1,M0 

SHITS     (5,1C0)      I, J 

CALL    RDREAL     (ANSR) 

AY  (I.J)  =  ANSR 

CONTINUE 

CONTINUE 


S3 


70 

80 

90 


C 

100 
1  10 


120 

130 

1U0 
150 
160 


.  (IANS.  NE.IZ)  )     GC    7C    5J 


CONTIN  DE 

If     (IANS.E0.IZ)     G 

WRITE"     (5.150) 

CALL    3DI5T     (IANS) 

K=IANS 

WRITS     (5,16  0) 

call  snrNT    cs 


90 


H  HITi:  (5  ,  lb  J 
CALL  3DINT  ( 
L=IANS 

r  ,100) 


ANS) 


WRITE     (5,100)     K.L 

CALL    RDREAL     (ANS3) 

DUM=ANSR 

DC    BO     1=1,  MO 

DO   70   j=i,no 


7b  j  =  i',no 

I.2Q.K)  .AND-  (J.EQ.L)  )     AY  (I,  J)  =  DUM 


IF  IS1.-* 

)NTINUE 


COll   11.1    U  L. 

CONTINUE 
GO    TO    30 
CONTINUE 
CALL    FRTCMS 
RETURN 


('CL3SCSN    ') 


5X,14HTEE    ELEMENT    i.  (  ,  12,  Hi,  ,  12,  2H)  =) 

!//,5X  ,54RENTER    THE    OUTEUT    MEASUREMENT 
',  5X,53  KDIMEfcSION    =    *     CESERVATIONS       NO 


COST    MATRIX       "A"-MAT 
X     *    OBSERVATIONS       NO 


FCSMAT 

FORMAT 
1RIJC    .,/ 
2    ) 

FORMAT     (//,5X  ,50HTHE    OUTPUT     MEASUREMENT    COST    MATRIX       "A"-MATRIX 

1-.//J 

FCSMAT 
1ENT?,// 

FORMAT 

FORMAT 
FORMAT 
1.) 
END 


(//5X,5UEDC    YCU    WISH    TO    CHANGE    THE    VALUE    0?    ANY    MATRIX    ELEM 
,  1CX,  1  9H1YEE    "YES"    OR     "NO".) 

(  1X.5 1HWARNING:     IMPROPER    DATA     ENTRY!       ENTER    "YES"    OR    "NO".) 
(5X,50HENTER    THE     RCW     NUMBER    OF    THE    ELEMENT     TO    BE    CHANGED.) 
5X,53HENTER    THE    COLUMN    NUMBER    OF    THE    ELEMENT    TO    3£    CHANGED 
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c 


10 

c  — 

20 


30 

40 
50 


60 
70 


C 

80 

90 

100 
113 

120 
130 
140 


SUBROUTINE  3EAD3  <NC,3) 

EHTEHS  THE  "B"  MATRIX CONTaCI  COST  BEIGHTIHG  MATRIX 

ZZAL**       E  (NC,  NC)  ,EUM,ANS3 
INTEGER  IANS, I,  J,?, L 
EATA  IY/» Y' /,  12/' N «/ 
WRITE 


10 
10 


filSt 


DC 

dc   10   j=i,nc 

WRITE     (5,e0) 
CALL    1D3EAL 
B  (I, J)  =  ANSR 


I.J 

(  AN3  3) 


CALL    PBTCHS     ('CLaSCBN    ') 

WHITE     (5,100) 

CALL    MATE3T     (E,NC,NC) 

BEITS     (5,110) 

CALL    SDCH&B     (IANS) 

I?     (  (I  ANS.NE.I1)  .AND.  (IANS.  NE.IZ)  )     GC    TC    40 

GC    TO    50 

IBII2     (5,120) 

GC    TO    30 

CONTINUE 

IF     (IANS. EQ. IZ)     GC    TC    70 

WRITE      (5.130) 

CALL    3DINT     (IANS) 

K=IANS 

WBITE     (5,140) 

CALL    3DIST     (IANS) 

L=IANS 

WRITE     f5,S0)      K,L 

CALL    RDBEAL     (ANSS) 

DUM=ANS3 

DC    60     1=1, SC 

DO    60    J=1,NC 

IF    (JI.  EC.K)  .  ANE.  (J.  EQ.L)  )     B(I,J)*0DH 

CGNTIN  UE 

GG    TO    20 

CONTINUE 

CALL    F3TCMS     ('CLSSCEN    ') 

RETURN 


PORMAT 

FOBMAT 

II     ,/,10 

format 

POEHAT 

1ENT?,// 

FCEMAI 
FORMAT 
FCEMAI 


END 


(5X,1ttHTBE    ELEMENT    3  (  ,  12  ,  1  H,  ,  12  ,  2Hj  =) 

|/,5X, 52EIN1E3    THE    CONTROL    COST    WEIGHTING    MATRIX       "3"-2ATRI 
X,45HDIMENSIC:i   =     *    C0NTECL5        NC       X    f    CONTROLS       NC    ) 
(//.10X.37HTHE   CONTROL    CCST    MATBIX B. ..,//) 

(//5X.54KDC    YOU    WISH    TC    CHANGE    THE    VALUE    OF    ANY    MAT2IX    ELEM 
,  10X. 1 9HTYEE    "YES"    OB    "SC".) 

(  1X,51HWA3NING:    IMPROPER    DATA     ENTRY!       ENTER    "YES"    OR    "NO".) 
(5X,50HIHTEB     IHE     3CW     NUSBER    OF    THE    ELEMENT    TO    BE    CHANGED.) 
(5X,52HENTER    THE    COLUMN    HUSOES    OF    THE    ELEMENT    TO    BE    CHANGED 
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c=====================================  ===========  =  ================== 

SUBROUTINE    3EADG2     (NS,  M  G  ,  IS  A3  ,GAM) 
C  ENTERS    THE    "GAa"    EAT3II        PROCESS    NOISE    DISTRIBUTION    MATRIX    . 

C  =  =  =  =  =  =  ====  ==  =  =  =  =  =  =  =  ==  =  ===  =  =  =  =  ======  =  ===  ======  =  =  ==  =  =  =  ===  =  =  =  =  =  =  =  =  ==  = 

SEAL'S        GAM (NS,NG) ,DCM, ANSR 

INTEGER    IANS,I  ,v  ,is,L,I3AM 

CATA    n/'Y'/.IZ/'SV 

IF     (IGAH.EQ.  1)     GC    TO    40 

a  BITE     (5,12  0) 

DC    20    1=1, HS 

DO    10    j=i.ng 

a  SITE     (5,110)      I,  J 

CALL    2DaE&L     (ANSR) 

GAM  (I,  J)  =&HS2 
10  CONTINUE 

20  CONTINUE 

C 

30  CALL    ?  FT  CMS     ('CL3SCRN    •) 

40  CONTINUE 

WHITS     (5,130) 

CALL    MATEST     (GAfl,NS,NG) 
50  »BITE     (5,140) 

CALL    3DCHAR     (IANS) 

IP    (  (I ANS.NE. IY)  -AND.  (IANS.  S2.IZ)  )    GO    TO    60 

GO    TO    70 
60  HSITE     (5,150) 

go   ro   50 

70  CONTINUE 

I?     (IANS.  SO.  IZ)     GC    TC    100 

aaiTZ    (5,160) 

CALL    3DIN1     (IANS) 

K=IANS 

SPITE     (5,170) 

CAL-    SDINT     (IANS) 

L=IANS 

WRITE     (5,110)      K,L 

CALL    3DREAL     (AKS3) 

DUH=AHSB 

DO    90    1=1, NS 

nn      art       1=1      vl  C 

I?     (  (I  .EqIk)  .  AND.  (J.ZQ.  L)  )     G  AS  |I,  J)  =  DUM 
80  CONTINUE 

90  CONTINUE 

GC    TO    30 
100  CONTINUE 

CALL    FSTCMS     ('CL3SC5N    ') 

3ETURN 
c 

110  FOHMAT     (5X.16HTHE    ELEHENT    G  Art  (  ,12  ,  1  H  ,  ,  I  2,  2  H)  =) 

120  FOBMAT     (/,oX, 36EESTE3    THE    PROCESS    NOISE    D  ISTRI3UTI0  N  ,/  ,  5X  ,  24H  M  ATRI 

1X       "r,AMMA"-MATBIX    .  ,/,2X,  56BDI3EMSIO  N    =    *    STATES       NS       X    #    PROCESS 

9  M  H  T  ^  7      ^  O  T1  J3  f^"  **  ^  M  f*      ^ 

130  FORMAT     (//,10X,37HTHS    PROCESS     SCISE    DISTRIBUTION    M ATRIX, /,  1 0X ,  19 H 

1  "GAil'V-r.ATPIl    ...    //) 
140  FORMAT     (//5X,54HDC'YCU    WISH    TC    CHANGE    THE    7ALUE    OF    ANY    HAT3IX    SLEM 

1ENT?,//,  1CX,  19HTYEZ    "YES"    OR     "NO".) 
150  FORMAT     (  1  X,  5  1  H  ViA  3  NI  NG:    IMFROPE3    DATA    ENTHY  !        ENTER    "YES"    OR    "NO".) 

160  F03MAT       5X,50EENTER    THE    3GW    NUMBER    OF    THE    ELEMENT    TO    BE    CHANGED.) 

170  FORMAT     (5X,53HENTER    THE    CCLUHN    NUMBE3    CF    THE    ELEMENT    TO    BE    CHANGED 

1.) 

END 
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c 


SUBROUTINE    REAIO      |NG,Q) 
INTERACTIVELY     ENTEES    THI 


"Q"     MATRIX       NOISE    WEIGHTING    MATRIX 


10 
20 
C  — 
3C 


U0 

50 
60 


HEAL*3        C(NG,NG) 
INTEGER     IANS, I. J 
DATA    IY/'IV.  11/ 
WRITS     (5,110) 
DC    20     1=  i  ,NG 
DC    10    J>1,3G 
WRITE      (5,100)      I, J 
CALL    RDREAL     (ANS3) 
Q  (I,J)  =4NSil 
CONTINUE 
CONTINUE 


,  CUM  ,ANSR 
/  '  N  '  / 


70 
80 

90 


C 

100 
110 


120 
130 

1U0 
150 
160 


CALL    FRTCMS     ('CLRSCSN    •) 

WHITE     (5,120) 

CALL    MATFET     (Q-SG.HG) 

WRITE     (5,130) 

CALL    RDCHA2     (IANS) 

I?     (  (IANS.NE.IY)  .  AND.  (IANS.  NE.IZ)  )     GC    TC    50 

5C    fo    60 

WRITE      (5,140) 

GC    TO    40 

CONTINUE 

IF     (IANS. SO. IZ)     GC    TO    90 

WHITE      (5,150) 

CALL    3DINT     (IANS) 

K=IANS 

WSirS     (5,160) 

CALL    RDINT     (IANS) 

L=IANS 

WRITE     (5,100)      K.L 

CALL    RDP.EAL     (ANSR) 

DUM=ANSR 

DO    SO     1=1, NG 

DO    70    J=1  ,NG 

IF     (  (I.  SC..X)  .  AND.  (J.  ZQ.L)  )     Q(I,J)=DUM 

CONTINUE 

CONTINUE 

GO    TO    3  0 

CONTINUE 

CALL    FRTCMS     ('CLESCEN    •) 

BETUHN 


FCEMAT 

FORMAT 

1 , 12H    " 

2    X,/,1 

FORMAT 

FCBMAT 

1ENT?./ 

FORMAT 

FORMAT 

FORMAT 

END 


UHTEE    ELEMENT    0  (  ,  I  2  ,  1  H,  ,  12  ,  2H)  =) 

X,U4HENTEa    THE'PRCCESS    NCISE    PSD    WEIGHTING    MATRIX,/, 5X 
IX    .  r//,5X,U2HDIMEbSION    =    *    PROCESS    NOISE    SOURCES       NG 
#FFCCESS     NOISE    SCUECES        NG    ) 


X.U2HTHS    PROCESS     SCISE    WEIGHTING    MATRIX Q..,//) 

'    OF    ANY    MATRIX    2L 


EM 


, 54HDC    YCU    WISH    TO    CHANGE    THE    VALU 

19HTYEE    "YES"    OR     "NO".) 

1H9AHNING:     IMPROPER    DATA     ENTRY!        ENTER    "YES"    OH    "NO".) 

OHENTER    THE     BCS     NUC3ER    OF    THE    ELEMENT    TO    BE    CHANGED.) 
3BENTER    THE    COLUMN    NUM3ER    OF    THE    ELEMENT    TO    BE    CHANGED 
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c 


SUBROUTINE  BE  ACE  (SO,HC) 

ENTERS   THE  "H"  MATRIX   MEASUREMENT 


NOISE  DISTRIBUTION  MATRIX 


10 

c  — 

2C 


30 

ao 
so 


BEAL*3        EC(NO, NO)  ,£UM,ANSR 
INTEGER     IANS,I,o,K,L 
DATA    lY/'Y'/, 
*RIT2     {3,SC) 
DC    10     1=1, NO 


r    t 


VV't 


DC    10    J=1.NO 
KBIT?     (5,80) 
CALL    RDREAL 
RC  (I, J)  =ANSR 


I.J 

(ANSR) 


60 
70 


C  — 
30 

90 


100 

110 

120 
130 
140 


CALL    FRTCMS     ('CLRSCSN    ') 

WHITE     (5,100) 

CALL    MATPET     (RC,NC,NC) 

WEITE     (5,110) 

CALL    RDCHAR     (IANS) 

I?     ((TANS. HE.  12)  .AND.  (IANS.  N£. 

GC    TO    50 

WRITE     (5,120) 

GC    TO    30 

CONTIN  U2 

IE    (IAHS.IQ.  IZ)     GC    TC    70 

WRITE     (5,130) 

CALL    RDI.NT     (IANS) 

K=IANS 

WBITE     (5,1U0) 

CALL    RDIN1     (IANS) 

L=IANS 

WRITE     (5,80)      K,L 

CALL    RDSrAL     (ANSR) 

DUM=ANSR 

DC    60     1=1, NO 

DO    60    J=1,NO 

IF     [(I.EQ.K) 

GO    TO    20 

CCNTINOE 

CALL    FRTCMS 

BETURN 


IZ)  )    GC    TC    ao 


AND.  (J.  EQ.  L)  )     RC|I,J)=DU« 


('CLESCEN    ') 


FCRMAT 
FORMAT 

1R"MATR 

2NS  NO 
FORMAT 

1..  ,//) 
FORMAT 

1ENT?,/ 
FORMAT 
FORMAT 
FORMAT 


'  5X.1UHTEE     ELEMEN' 
I/,5X,6CHZNTER    TH! 


ENl 


R(,I2,1H,,I2.2H)=) 
MEASUREMENT    NCISE 
IX"  L, //,  5  X, 53  H  DIMENSION    = 

(//,15X,5CHTHE    MEASUREMENT    NOISE    DISTRIBUTION 

(//5X.54HDC    YCO    WISH    TC    CHANGE    THE    VALOE    OF 
/,  1CX,  19EIYEZ    "YES"    OR     "NO".) 

1X,51 HWARNING:    IMPROPER    DATA    ENTRY! 
5X,50HENTER     THE    RCW    NUMBER    OF    IHE    EL 
5X,52HENIER    THE    CCLUM*    NUMBEE    OF    THE 


DISTRIBUTION    MATRIX       " 
IONS       NO       X     S    OBSERV\TIO 

MATRIX R. 

ANY    MATRIX    SLEM 

ENTER    "YES"    OR    "NO".) 
M2NT    TO    BE    CHANGED. ) 
ELEMENT    TO    BE    CHANGED 
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c 
c== 


SOEEOUTINE    REAEFE 
INTEHACTIVELY     ENTi 


(BS, NO,  FBGE) 

ES    THE    "K"       FEEDBACK    GAIN    ESTIMATOR    MATRIX 


10 
20 
C  — 
3C 


40 

50 
60 


r  EGE(XS,NC)  ,  EOH,  ANSR 
IANS    " 


SEAL*3        rEGE(NS,:iC)  ,I 

INTEGER    IANS, I, J, K.I 

DATA    II/'T'/i IZ/« N'/ 

WHITS     (5.110) 

DC    20     1=1, MS 

DC    10    J=1,NO 

WHITS     (5,10  0)     I,  J 

CALL    SERIAL     (ANSR) 

FBGE  (I  ,  J)  =  ANSR 

CONTINUE 

CONTINUE 


70 
30 

90 


C  — - 

100 

110 

120 

130 

no 

150 
160 


CALL    FRTCSS     ('CIRSCEN    •) 
WRITS     (5.120) 
CALL    HATPET     (  FEGE  ,  NS  ,  NO) 
WHITE     (5,130) 
CALL    RECEAR     (IANS) 
[(IANS.NE.II)  .1 


IF 


GC    TO    6  0 

WHITE     (5,140) 

GC    TO    40 

CONTINUE 

IE     (IAUS.ZQ. 12)     GC    TC    90 

WHITE      (5.150) 

CALL    HEIST     (IANS) 

K=IAMS 

WHITE     (5,160) 

CALL    3DIN1     (IANS) 

L=IANS 

WHITE     (5,100)     »,L 

CALL    RERZAL     (ANSE) 

DUM=ANSR 

DC    30     1=1, NS 

DO    70    J=1,NO 

IF     ((I.EC.K) 

CONTINUE 

CONTINUE 

GO    TO    30 

CONTINUE 

CALL    PRTCMS 

BETUHN 


)  .AND.  (IANS.  NE.IZ)  )     GC    TC    50 


AND.  (J.  EQ.L)  )     FBGE  (I, J)  =  D0M 


('CLBSCEN    ') 


FCEMAT 

FORMAT 

112    .,/ 

FORMAT 

V/) 

FCEMAT 
1MENT?. 
FORMAT 
FORMAT 
FORMAT 
1) 
END 


(5X    14RTEE    ELEMENT    K(,I2,1H,     12    2H)  =) 

(/-5X.51H2HTEB   THE    FEE EEACK' G AIN    ESTIMATOR    MATRIX       "K"-MATR 


/,  1 CX,  JSHDIKENSION    =    4    STATES        NS       X    t    OBSERVATIONS 
(//,15X,47HTHE   FEEE3ACK    GAIN     ESTIMATOR    MATRIX       "K"-MATR 


(//,5X, 5URCO    YOU    WISH    TO    CHANGE    THE    7AL0E    OF    ANY    HATHIX    ELE 
/.10X. 1 9HTYEE    "YES"    CR    "NO".) 
IX, 5  1  HWARNING:     IMPROPER    DATA     ENTRY!       ENTER    "YES"    OR    "NO".) 

5X,50HENTER    THE    H  CW     NUMBER    OF    TEE    ELEMENT    TO    BE    CHANGED.) 
5X,52HENIER    IHE    COLUMN    NUM3E6    CF    THE    ELEMENT    TO    BE    CHANGED 
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0==  =  =  =  =  ======  =  =  =  ===  =  =  =  ===  =  ==  =  ==  =  =  =  ========  =  =  =  ===  =  =====  =  ====  =  =  =  =  ===  =  = 

5UEHOUIIHE    REAL*     (HG,WR) 

C  INTERACTIVELY     ENTERS    "WO"       STEADY    DISTURBANCE    VECTOR  = 

C===  =  =  =============  =  =  =  =  ===  =  =  =  =  =  ==================  ==  ===  =  =  ====  =  ===  =  =  = 

SEAL*3        WB(NG)  ,£UH, ANSR 
INTEGER    IANS, I, X 
DATA    IY/'Y' /, it/'  N'/ 
WRITE      (5,100) 
DC    10    1=1. NG 
HRITE     (5,30)      I 
CALL    3DREAL     (ASS5) 
Hfi  (I)  =  ANSS 

10  CONTINUE 

c 

2C  CALL    FRTCMS     ('CL2SCBK    •) 

WHITE     (5,110) 

WRITE     (5,90)      (IH(I)  ,1=1, NG) 
30  WRITE     (5  - 120) 

CALL    RDChAR     (IANS) 

IF     (  (I  ANS.NE.IY)  .AHD.  (IANS.  ME.ZZ)  )    GC    TC    40 

GC    TO    50 
40  WRITE      (5,13  0) 

GC    TO    30 
50  CONTINUE 

IF     (IANS- EQ. IZ)     GC    TC    70 

WRITS      (5,140) 

CALL    RDINT     (IANS) 

K=IANS 

WHITE     (5,£0)     K 

CALL    RDREAL     (ANSP) 

DUM=ANSR 

DO    60    1*1. NG 

IF     (I.  ZC.X)     WR  (I)  =  DUM 
60  CONTINUE 

GC    TO    20 
70  CONTINUE 

CALL    FSTCMS     ('CLRSCHN    ') 

RETURN 
c 

30  FORMAT     (5X.15HTRE    ELEMENT    S0(,I2,2H)=) 

90  FCSflAI     {  E  12. 5) 

100  FORMAT     (/,5X.57H2U'EEH    THE    STEAD?    DTSTUREANCE    VECTOR    MATRIX        "W0"-M 

1ATRIX     .  ,//,10X,44HDIMSNSICN    =     I    PROCESS    NOISE    SOURCES       NG       X     1) 
110  FORMA!     (//,1  5X,53HT3c    STEADY    DISTURBANCE    VECTOR    MATRIX       "W0"-KATRI 

1X     ...,//) 
120  FORMAT     (//5X.54HDC    YCU    WISH    TC    CHANGE    TBE    VALUE    OF    ANY    MATRIX    ELEM 

1ENT?,//,  10X,  19ETYFE    "YES"    OR     "NO".) 
130  FORMAT     (  1  X ,51 H W Afi NI NG:     IMFROPES    DATA     ENTRY!        ENTER    "YES"    OR    "NO".) 

140  FORMAT      (5X,50HENIER     IHS     RCW    NDC3ER    OF    IHE    ELEMENT    TO    3E    CHANGED.) 

END 
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c  ===========================  =  ================================  ======= 

C       SUBROUTINE    BDREAL    --    I NTE2 ACTI V EIY    READS    A    HEAL    NUN3ER    REPLY 

C       INTC    A    FORTRAN    PBGGaAM.       IP    THE    USER    INADVE3TENLY    ENTERS       A    NULL  = 

C       STRING    THE    S/R    ISSUES    A    WARNING     AND    ALLOWS    A    RECOVERY. 

C==  =============  =  =  ======  ====  =  =  ==========  ======  ====  =======  =  =  ===  =  == 

SUBROUTINE    RDREAL     (AtiSR) 

3EAL*3     ANSR 
INTEGER    CCUNT 

COUNT=0 
10  CONTINUE 

CCQNT=COCNT+1 

IF     (COUNT. LT. 3)     GC    TO    20 

WRITS     (5,60) 

GO    TO    40 
20  CONTINUE 

READ     (5,*,END=30,EBR=30)      ANSR 

RETURN 
30  REWIND    5 

WRITS  (5,50) 

GC  TO  10 
40     CONTINUE 

STOP 
c 

50  FOBHAT     (  U,64HWARNING:        NULL    STRINGS     ARE    NOT    ALLOWED,     ENTER    A    NUBE 

1RICAL    VALUE.) 
60  FCRSAT     (////, 2X,42HPEOG3AM    SILLED    -    TWO    NULL    STRINGS    ENTERED!,/) 

END 
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c===========— ===============  ================  =  =============—=— =—===^ 

C       SCBHQUTIH5    HDIMT    —    INTERACTIVELY    PEADS     AN    INTEGER    REPLY  = 

C       INTO    A    FORTRAN    PROGRAM.       IF    THE    CSER    INADVERTSNLY     ENTERS    AN     IMPROPER= 
C    _CATA    CHARACTER    THE    S/R     ISSUES    A_«ARNIHG     AND_ ALLOWS    A_fZCOVERY. 

SUEROUTINE    3DINT     (IANS) 

INTEGER    COUNT, IANS 
c 

CQUNT^O 
10  CONTINUE 

CCL'NT=COCNT  +  1 

IF  (COUNT. LT. 3)  GC  TC  20 

■  RITE  iS  ,60) 

GO  TO  50 
20     CONTINUE 

READ     (5, *,SND=U0, ERR=U0)      IANS 

I?     (IANS)     40, 40,30 
30  CONTINUE 

RETURN 
40  REWIND    5 

SiRITE     (5,70) 

GC    TO     10 
50  CONTINUE 

STOP 
c 

50  FORMAT     (//, 5 X , 49 5ERCGRAM    TERMINATION'-    ISO    IMPROPER    DATA    ENTRIES!! 

1) 
70  FORMAT     ( U , 5 6H W ARMING:     IMPROPER    DATA    ENTRY!       ENTER    A    POSITIVE    INTE 

1GER.) 
ENC 
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C       SUEBCUTIHI    BEC3AB    —    INTER ACTI7 ELY    HEADS    A    CHARACTER    STRING    REPLY 
C        ('YES'    OR     •  NC)     ISTC    A    FOETRAH     F5CGRAK.     IF    THE    USSR    IN  AOV  ERTENL  Y 

c  _ESTsas  _a_null_stbi::g  tee  s/r  issues  a    warning  a;;d  allows   \  ssco?ery= 

SUBROUTINE  RDCHAR  (IANS) 

INTEGER  CCUN?,IANS 

C      DAT.\  I  Y/«  Y'/rlZ/'  KV 

c 

CCCNT=0 
10  CONTINUE 

COUN'T=COCNT+  1 

I?  (COUNT. LT. 3)  GC  TC  20 

WRITS  (5,60) 

GC  TO  40 
20     CONTINUE 

SESIND  5 

READ  (5, 7C,END=3G,SRR=30)  IANS 

SETURN 
30     RE5IND  5 

WBITS     (5,50) 

GC    TO    TO 
40  CONTINUE 

STOP 

C ■ 

50  FORMAT     (  1  X,6  0 H WAR NI NG:        NULL    STBINGS     ARE    SOT    ALLOWED,     ENTER     "YES" 

1CH    "MO". ) 
60  FORMAT     (///,5X,47HPRCGHAM   TERMINATION    -    TWO    NULL    STRINGS    ENTERED!) 

70  FCHMAT     (A1) 

END 
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OBROUTINE    MATPRT    —    DISPLAYS    A    T  ViC-DI  M  F.  NS  ION  AL    ARRAY 
H    7ABIASLZ    SCREEN    FC3MAT    FOR    USER    EASE     IN    ROM    ID2NTIF 


(16 

ICA 


COLS. 
HON. 


MAX) 


SCEKOUTINE  MATEET  (EBTT  , HBOS , KCCL) 

IMPLICIT  R£AL*8  (A-E.O-Z) 
DIMENSION  ?RTT  (NFOW,NCOL) 


C  — - 

10 

20 

30 

40 

50 

60 

70 

30 

90 

100 

110 

120 

130 

140 

150 

160 


IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

11  NCOL. 

I?  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 

IF  (NCOL. 
EETa3N 


EQ.O) 
EQ.  ij 

EQ.2) 
EQ  •  3  ) 
EQ.4J 
EQ .  5 
EQ.  6  ) 
EQ.7 
EQ.3) 
EQ.9) 
EO. 1 0) 
EQ.11 
EQ. 12] 
EQ.1  3 
EQ.  14 
EQ.15 
EQ. 1 6; 


NCCL=1 

'WRITE 

(b, 

10) 

WRIT; 

(5 

20) 

BBITE 

5 

40  ( 

WRITE 

5, 

WRITE 

(b 

50) 

WRITE 

5 

60) 

WRITE 

5 

70 

WRITE 

(5 

,30) 

WRITE 

5 

90) 

WRITE 

b 

,100) 

WRIT  E 

b 

110) 

WRITE 

(5 

120) 

WRITE 

(b 

,130) 

WRITE 

(b 

,  140) 

WRITE 

(b 

,  15  0) 

WRITE 

(b 

r  160) 

(  (PRTT 
((PRTT 
(  (PSTT 

I   <T>  'ST""' 

((PRTT 

PHTT 
PRTT 

PRTT 
PRTT 
(  (PHTT 
((PRTT 
((PRTT 
((PRTT 
((PRTT 
(  (PRTT 


,J  = 


(I, J)  ,J 

(I,  J)  ,J 

(I,  J)  ,J 

I, J.  . 

(If  Ji  rJ 

(I, J  .J 
(I.J)  ,J 
(I.J)  ,J 

(I.J)  .J 
(I.J)  ,J 
(I, J)  .J 
(I.J)  .J 
(I, J)  .J 
(I.J)  ,J 
(I.J)  .J 
(I.J)  fJ 


1.NCOL) 
1,  NCOL) 
1,  NCOL) 
1.MCOL) 
1,  NCOL) 
1.NCOL) 
1.NCOL) 
1,  NCOL) 
1.NCOL) 
1, NCOL 
1,  NCOL) 
1.NCOL) 
1,  NCOL) 
1.NCOL) 
1,  NCOL) 
1.NCOL) 


.1  = 
,  1= 
,  1= 
.1= 
,  1= 
.1  = 
.1  = 
.  1  = 
,1  = 
,  1= 
,1  = 
,1  = 
.1  = 
,1  = 
,1= 
,1= 


1.NROW) 
1.NROW) 
1,N'ROW) 
1  ,  N  R  0  9 ) 
1 ,  N  R  0  W ) 
l.NROW) 
1  ,  N  R  0  W ) 
1 ,  N  R  0  W ) 
1 ,  N  8  0  W 
1.NROW) 
1.NROW) 
1  ,  N  R  0  W  ) 
1,'JROW) 
1  ,  N  R  0  W ) 
1.NR0W) 
1.NR0W) 


FCEMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
FOEHAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
PORMAT 
FORMAT 
FORMAT 
FORMAT 
FORMAT 
END 


(F1 

IB 

(4F 

(6F 
6F 
6r 
6r 
6F 

(6F 
6F 

( 6F 
6F 

(6F 

(6F 


2.5 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 
12. 


b ) 
5 

5,/, 

3,/, 


E12.5,//) 
2F12.5,//) 

3F12.5,// 
4F12.5,// 
Sf  12.5,//} 

6F12.5,//) 
6F12.5./.F12.5,//) 

6F12.5,/,2F12.5,//) 
6F.12.5,/,3F12.5,//j 
6F12.5,/,4P12.5,//) 
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C       SOBROUTINE    MATPRT    —    DISPLAYS    A    T WC-DI M E SS ION AL    ARRAY     (16    COLS.     MAX); 

C       IH    7ABIABLE    SCREEN    FORMAT    FOR    USER    EASE     IN    ROB    ID ENTIrlCATION . 

C  ===  ============  =  =  ========  =  ==  =  =======  ===  =  ==========  =  =  ===  =  ======- 

SGEROOTINE    MATES!     (EST?  ,  N  SOW  ,  hCCL) 
IHFLICIT     REAL*8     (A-B,0-Z) 
DIMENSION    ?RTT     (HEOU  ,NCOL) 

C 

IF     (NCOL.ZQ.O)     NCCL=1 

IF  (NCOL.EQ.1)  WRITE  (5,10)  ( (PP.TT  (I  ,  J)  ,  J=  1 ,  NCO  L)  ,  1=  1  ,  NROW) 
IF  (NCOL.EQ.2)  WRITE  (5,20)  ( (  P5TT  (I  ,  J)  ,  J=  1  ,  8COL)  ,  1=  1  ,  N  RO  W) 
IF      NCOL.EQ.3  SPITE     (5,30)         (  (PRTT  (I ,  J)  ,  J=  1 ,  HCOl    ,  1=  1,  MHO  W) 

IF  (NC0L.EQ.4)  WRITE  (5,40)  (  (PRTT  (I ,  J  ,  J=  1  ,  NCO  L)  ,  1=  1  ,  NRCW) 
IF  (NCOL. £0.5)  WRITE  (5,50)  (  (PRTT  (I  ,  J  ,  J=  1 ,  NCO  L)  ,  1=  1 ,  N  ROW) 
IF  (NCOL.EQ.6)  WRITS  (5,60)  |  (PRTT  (I ,  J)  ,  J=  1  ,  NCO  L)  ,  1=  1 ,  NRO  W) 
IF  (NC0L.EQ.7)  WRITE  (5,70)  <  (PRTT  (I ,  J)  ,  J=  1  ,  NCOL)  ,  1  =  1  ,  S  RO  W) 
IF     (NCOL.EQ.3  WRITE     (5,30)         (  (  PRTT  (I ,  J)  ,  J=  1  ,  NCOL)  ,  1=  1 ,  N  ROW) 

IF  (NCOL.EQ.9)  WRITE  (5,90)  (  (PRTT  (I  ,  J)  ,  J=  1  ,  NCO  L)  ,  1=  1  ,  H  ROW) 
I?  (SCOL.EO-10)  WRITE  (5,100)  (  (PRTT  (I ,  J)  ,  J=  1 ,  NCOL  ,  1=  1 ,  NROW) 
IF  (NCOL. EQ. 11  WRITE  (5,110)  <  (PRTT  |I  ,  J)  ,  J=  1 ,  NCO  L)  ,  1=  1 ,  N  ROW) 
IF  (NCOL. EQ.  12)  WHITE  (5,120)  ( (  PRTT  (I  ,  J)  ,  J=  1  ,  NCOL)  ,1=  1  ,  NROW) 
IF  (NCOL.  EQ.  13)  WBITE  (5,130)  (  (PRTT  (I ,  J)  ,  J=  1  ,  NCOL)  ,  1=  1 ,  M  RO  W) 
IF  (HCOL.  iQ.  14)  WRITE  (5,140)  (  (PRTT  (I  ,  J)  ,  J=  1  ,  NCOL)  ,  1=  1 ,  N  ROW) 
I?  (NCOL. EQ. 15)  WRITE  (5,150)  (  (PRTT  (I  ,  J)  ,  J=  1 ,  NCO  L)  ,  1=  1  ,  N  ROW  ) 
IF  (NCOL.EQ-16)  WRITE  (5,160)  (  (PRTT  (I  ,  J)  ,  J=  1  ,  NCOL)  ,  1=  1 ,  N  RO  W) 
BET03N 

c 

10  FORMAT  (F12.5) 

20  FORMAT  (2F12.5) 

30  FCRMAT  (3E12.5) 

40  FORMAT  (4P12.5) 

50  FORMAT  (5J12.5) 

60  FORMAT  (6P12.5) 

70  FCEMAT  (6 F1 2. 5 ,/, f 1 2 .5,  //) 

30  FORMAT  (6F12. 5  ,/,2?l2.5 ,//) 

90  FORMAT  ( 6 E1 2 . 5 ,/ , 3F 1 2. 5 , // 

100  FORMAT  (6F12.5,/,4F12.5,//) 

110  FCRMAT  (6F12.  5  ,/ ,  5F  1  2.  5  , //) 

120  FORMAT  ( 6F1 2 . 5  ,/ ,6? 1 2.5 , //) 

130  FORMAT  (6  F 1  2.  5  ,/ ,  6F  1  2.  5 ,  /  ,F  1  2  .  5. //) 

140  FORMAT  6P1  2  .  5  ,/ ,  6F  1  2.  5  ,  /  ,2F  1  2.5  ,//) 

150  FORMAT  (6F1  2.  5  ,/ ,  6F  1  2.5  ,  / ,  3P  1  2.5  ,//) 

160  FORMAT  ( 6F1 2 . 5  ,/ , 6F 1 2.5 ,/ ,4P 1 2.5 ,//) 
ENC 
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